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(54) 【 発 明 の 名 称 】 モー ショ ン キ ャ プチ ャ デー タ を 模 依 する ロボ ッ ト の 追跡 及び バラ ンス 維持 シス テム 及び 方 法 


(57【 要約 】 ( 修正 有 ) 

【 課題 】 モー ショ ン キ ャ プチ ャ デー タ に 基き 、 自 然 な 動 
作 ( 例え ば 人 間 の よう な 動作 ) を 実行 する ロボ ッ ト を 提 
供する こと 。 

【 解決 手段 】 コ ント ロー ラ 1 0 0 を 、 バ ラン ス 制 御 信号 
を 供給 する よう に 構成 され た バラ ンス コン ト ロー ラ 1 0 
1 と 、 前 記 バ ラン ス 制 御 信 号 に 従っ て バラ ンス を 維持 し 
な が ら 入力 基準 動作 を 追跡 する よう に 設定 され た 動作 命 
令 を 生成 する よう に 構成 され た トラ ッ キ ング コン ト ロー 
ラ 1 0 2 と を 備え 、 ロ ボッ ト の 複数 の 関節 の 各々 が 前 記 
動作 命令 を 使用 で き 、 前 記 基 準 動作 の 追跡 及び バラ ンス 
の 維持 を も た ら す 構成 と し た 。 

【 選択 図 】 図 1 
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【 特許 請求 の 範囲 】 

請求 項 1 】 

機械 的 な 人 エエ エー ジェ ント で あっ て 、 

複数 の 関節 を 介し て 結合 され た 複数 の 可動 部 と 、 

前 記 複 数 の 可動 部 の 動作 を 制御 する よう に 構成 され た コン トロ ー ラ と 、 
を 備え 、 前 記 コ ント ロー ラ は 、 

バラ ンス 制御 信号 を 供給 する よう に 構成 され た バラ ンス コン トロ ー ラ と 、 

前 記 バ ラン ス 制 御 信号 に 従っ て バラ ンス を 維持 し な が ら 入 力 基 準 動作 を 追跡 する よう に 
設定 され た 動作 命令 を 生成 する よう に 構成 され た トラ ッ キ ング コン トロ ー ラ と を 備え 、 

前 記 複 数 の 関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 前 記 基準 動作 の 追跡 及び バラ ンス の 
維持 を も た ら す 、 機 械 的 な 人 エエ エー ジェ ント 。 

【 請求 項 2 】 

前 記 動 作 命令 は 関節 トル ク を 含む 、 請 求 項 1 記載 の 機械 的 な 人 エエ ー ジ ェ ン ト 。 
【 請求 項 3 】 

前 記 機械 的 な 人 工 エ ー ジ ェ ン ト は ヒュ ー マ ノ イド ロボ ッ ト で ある 、 請求 項 1 記載 の 機械 
的 な 人 エエ エー ジェ ント 。 

【 請求 項 4 】 

前 記 複 数 の 可動 部 は 1 つ 以 上 の 可動 下半身 部 分 を 有する 本 体 部 分 を 備え 、 前記 バラ ンス 
制御 信号 は 全身 バラ ンス モデ ル と 整合 し て いる 、 請 求 項 3 記載 の 機械 的 な 人 エエ ー ジ ェ ン 
ト 。 

【 请 求 项 5 】 

前 記 基準 動作 は モー ショ ン キ ャ プチ ャ シス テム か ら 得 られ る 1 つ 以 上 の デー タ 入 力 を 更 
に 含む 、 請 求 項 1 記載 の 機械 的 な 人 エエ エー ジェ ント 。 

【 請求 項 6 】 

前 記 基準 動作 は 1 つ 以 上 の 足踏み 動作 を 更に 含む 、 請 求 項 5 記載 の 機械 的 な 人 エエ エージ 
ェ エント 。 

【 請求 項 7 】 

前 記 コ ント ロー ラ は 、 

運動 学 的 マッ ピン グモ ジュ ー ル と 、 

動力 学 的 マッ ピン グモ ジュ ー ル と を 更に 備え る 、 請 求 項 4 記載 の 機械 的 な 人 エー ジェ 
ント 。 
請求 項 8 】 

前 記 運 動 学 的 マッ ピン グモ ジュ ー ル は 、 前 記 機 械 的 な 人 エエ エー ジェ ント の 1 つ 以 上 の 現 
在 接触 位置 を 用 いて 、1 つ 以 上 の 接触 位置 と 前 記 機械 的 な 人 エエ ー ジ ェ ン ト の 本 体 と の 間 
の 運動 学 的 関係 が 前 記 基 準 動作 を 追跡 する よう に 、1 つ 以 上 の 体 幹 軌道 及び 1 つ 以 上 の 関 
節 軌道 を 修正 する よう に 構成 され て いる 、 請 求 項 7 記載 の 機械 的 な 人 エー ジェ ント 。 

【 請求 項 9 】 

前 記 動 力学 的 マッ ピン グモ ジュ ー ル は 、 前 記 基 準 動作 を 追跡 し な が ら 圧 力 中 心 を 前 記 機 
械 的 な 人 エエ エージ ェ ン ト の 接触 凸 包 内 に 維持 する よう に 前 記 機 械 的 な 人 工 エ ー ジ ェ ン ト の 
基準 重心 を 修正 する よう に 構成 され て いる 、 請 求 項 7 記載 の 機械 的 な 人 エエ エージ ェ ン ト 。 
【 請求 項 1 0】 

基準 動作 に 対応 する 入力 デー タ を 受信 する ステ ッ プ と 、 

複数 の 関節 で 結合 され た 複数 の 可動 部 を 有する 機械 的 な 人 工 エ ー ジ ェ ン ト の トラ ッ キ ン 
グ コ ント ロー ラ に バラ ンス 制御 信号 を 供給 する ステ ッ プ と 、 

前 記 ト ラッ キン グ コ ント ロー ラ に よっ て 、 バ ラン ス を 維持 し な が ら 入 力 基準 動作 を 追跡 
する よう に 設定 され た 動作 命令 を 含む お トラッキング 制御 信号 を 供給 する ステ ッ プ と を 備え 
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前 記 複数 の 関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 前 記 基 準 動作 の 追跡 及び バラ ンス の 
維持 を も た ら す 、 方 法 。 
請求 項 1 1 】 


(3) JP 2010-221395 A 201010.7 


前 記 動 作 命令 は 関節 トル ク を 含む 、 請求 項 1 0 記載 の 方 法 。 

請求 項 1 2 】 

前 記 機械 的 な 人 工 エ ー ジ ェ ン ト は ヒュ ー マ ノ イド ロボ ッ ト で ある 、 請 求 項 1 0 記載 の 方 
法 。 

請求 項 1 3 】 

前 記 複 数 の 可動 部 は 1 つ 以 上 の 可動 下半身 部 分 を 有する 本 体 部 分 を 備え 、 前記 バラ ンス 
制御 信号 は 全身 バラ ンス モデ ル と 整合 し て いる 、 請 求 項 1 2 記載 の 方 法 。 

【 請求 項 1 4 】 

前 記 基準 動作 は モー ショ ン キ ャ プチ ャ シス テム か ら 得 られ る 1 つ 以 上 の デー タ 入 力 を 更 
に 含む 、 請 求 項 1 0 記載 の 方 法 。 

【 請求 項 15】 

前 記 基準 動作 は 1 つ 以 上 の 足踏み 動作 を 更に 含む 、 請 求 項 1 4 記載 の 方 法 。 

【 請求 項 1 6】 

運動 学 的 マッ ピン グモ ジュ ー ル 及び 動力 学 的 マッ ピン グモ ジュ ー ル を 用 いて 前 記 基 準 動 
作 に 対応 する 入力 デー タ を 前 処理 する ステ ッ プ を 更に 備え る 、 請 求 項 1 0 記載 の 方 法 。 

【 請求 項 1 7 】 

前 記 運 動 学 的 マッ ピン グモ ジュ ー ル を 用 いて 、1 つ 以 上 の 接触 位置 と 前 記 機械 的 な 人 工 
エー ジェ ント の 本 体 と の 間 の 運動 学 的 関係 が 前 記 基 準 動作 を 追跡 する よう に 1 つ 以 上 の 体 
幹 軌 道 及び 1 つ 以 上 の 関節 軌道 を 修正 する ステ ッ プ を 更に 備え る 、 請 求 項 1 6 記載 の 方 法 
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請求 項 1 8 】 
前 記 動力 学 的 マッ ピン グモ ジュ ー ル を 用 いて 、 前 記 基 準 動作 を 追跡 し な が ら 圧 力 中心 を 
前 記 機械 的 な 人 エエ ー ジ ェ ン ト の 接触 凸 包 内 に 維持 する よう に 前 記 機 械 的 な 人 エエ エー ジェ 
ント の 基準 重心 を 修正 する ステ ッ プ を 更に 備え る 、 請 求 項 1 6 記載 の 方 法 。 

【 請求 項 1 9】 

1 つ 以 上 の プロ セッ サ と 、 

複数 の 関節 で 結合 され た 複数 の 可動 部 を 有する 機械 的 な 人 工 エ ー ジ ェ ン ト の 動作 を 制御 
する よう に 構成 され た 、 前 記 1 つ 以 上 の プロ セッ サ に より 実行 可能 な コン ピュ ー タ 読み 取 
り 可 能 な プロ グラ ムコ ー ド を 有する プロ グラ ム 記 憶 装 置 と を 備え 、 該 プロ グラ ム 記 憶 装置 
は 、 

バラ ンス 制御 信号 を 供給 する よう に 設定 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ム 
コー ド と 、 

バラ ンス を 維持 し な が ら 入 力 基準 動作 を 追跡 する よう に 設定 され た 動作 命令 を 生成 する 
よう に 構成 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ムコ ー ド と を 含み 、 
前 記 複 数 の 関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 前 記 基 準 動作 の 追跡 及び バラ ンス の 維 
持 を も た ら す 、 装 置 。 

【 請求 項 2 0 】 

複数 の 関節 で 結合 され た 複数 の 可動 部 を 有する 機械 的 な 人 エエ ー ジ ェ ン ト の 動作 を 制御 
する よう に 構成 され た 、1 つ 以 上 の プロ セッ サ に より 実行 可能 な コン ピュ ー タ 読み 取り 可 
能 な プロ グラ ムコ ー ド を 有する プロ グラ ム 記 憶 装置 を 備え 、 該 プロ グラ ム 記 憶 装置 は 、 
バラ ンス 制御 信号 を 供給 する よう に 設定 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ム 
コー ド と 、 

バラ ンス を 維持 し な が ら 入 力 基 準 動作 を 追跡 する よう に 設定 され た 動作 命令 を 生成 する 
よう に 構成 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ムコ ー ド と を 含み 、 

前 記 複 数 の 関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 前 記 基 準 動作 の 追跡 及び バラ ンス の 維 
持 を も た ら す 、 コ ンピュータ プロ グラ ム プ ロダ クト 。 

【 発明 の 詳細 な 説明 】 

【 技術 分 野 】 

【0001】 
本 願 は 、2009 年 3 月 2 4 日 に 出願 され た 「 Simultaneous Tracking and Balancing 
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of Humanoid Robot for Imitating Human Motion」 と いう 名 称 の 米国 特許 出願 番号 第 6 1 

ググ 1 62, 838 号 の 優先 権 を 主張 する も の で あり 、 そ の 全 内 容 は 参照 する こと に より こ 
こ に 組み 込ま れる 。 

【 背景 技術 】 

【0002】 

特に 自然 な 動作 (例え ば 人 間 の よう な 動作 ) を 実行 する よう に ロボ ッ ト を プロ グラ ミン 
グ す る こと は 難し い 作 業 で ある 。 動作 は 、 動 力学 的 制約 及び 運動 学 的 制約 の 両方 又は い ず 
れ か の 下 で 例え ば エネ ルギー 消費 を 最小 に する た め に 通常 手 作 業 で 又は 多く の 数 値 最適 化 
技術 に より プロ グラ ム さ れ て いる 。 モ ーション キャ プチ ャ デー タ は 潜在 的 に 良好 な 出発 点 
で ある が 、 モ ーション キャ プチ ャ デー タ の 徒 来 の 使用 法 は ここ で 熟慮 され る よう に ロボ ッ 
ト を 追跡 し バラ ンス させ る に は 不 十分 で ある 。 

【 発明 の 概要 】 
【0003】 

本 発明 の 実施 例 は 、 仮 想 的 又は 機械 的 な 人 工 エ ー ジ ェ ン ト ( こ こ で は 「 ロ ボッ ト 」、 例 
えば ヒュ ー マ ノ イド (人 型 ) ロ ボッ ト と いう ) の た め の 制 御 フ レー ム ワ ー ク を 提供 する シス 
テム 、 方 法 、 装 置 及 び コ ンピュータ を 広く 含む 。 こ の 制御 フレ ー ム ワー ク は 、 動作 を 追跡 
し バラ ンス を 維持 する た め に 基準 動作 デー タ ( 例え ば モー ショ ン キ ャ プチ ャ デー タ 又 は ア 
ニメーション デー タ ) と すべ て の 関節 を 同時 に 用 いて いる 。 本 発明 の 一 実施 例 に よる コン 
ピュ ー タ は バラ ンス コン トロ ー ラ と トラ ッ キ ング コン トロ ー ラ の 2 つの 主要 な コン ポー ネ 
ント を 含む 。 本 発明 の 一 実施 例 で は 、 バ ラン スコ ント ロー ラ は 、 ロ ボッ ト の 現在 状態 に 基 
づい て バラ ンス を 維持 する た め の 所 望 の 入力 を 得 ら れる た め に 簡易 人 型 モ デル に 対し て 設 
計 さ れ た レギ ュ レ ー タ を 用 いる 。 簡易 モデ ル は 、 例 えば 最適 制御 を 用 いて レギ ュ レ ー タ を 
体系 的 に 設計 で きる よう に 選択 され る 。 一 例 と し て 、 倒 立 振子 モデ ル に 対し て 設計 され た 
線形 二 次 レ ギュ レー タ を 用 いる こと が で きる 。 所 望 の 入力 は 典型 的 に は いく つか の 代表 的 
な 関節 の 圧力 中 心 及び 又は トル ク で ある 。 本 発明 の 一 実施 例 で は 、 こ の と き ト ラッ キン 
グ コ ント ロー ラ は 、 全 人身 動 力学 を 考慮 し て 、 モ ーション キャ プチ ャ デー タ を 追跡 する た め 
に 所 望 の 入力 か ら の 差 の みな ら ず 所 望 の 関節 加速 度 か ら の 誤差 を 最小 に する 関節 トル ク を 
計算 する 。 

【0004】 

要する に 、 本 発明 の 一 つの 態様 は 、 複 数 の 関節 を 介し て 結合 され た 複数 の 可動 部 分 と 、 
前 記 複 数 の 可動 部 分 の 動作 を 制御 する よう に 構成 され た コン トロ ー ラ と を 備え 、 前 記 コ ン 
トロ ー ラ は バラ ンス 制御 信号 を 供給 する よう に 構成 され た バラ ンス コン トロ ー ラ と 、 バ ラ 
ンス 制御 信号 に 基づい て バラ ンス を 維持 し な が ら 人 入力 基準 動作 を 追跡 する よう に 設定 され 
た 動作 命令 を 生成 する よう に 構成 され た トラ ッ キ ング コン トロ ー ラ と を 備え 、 前 記 複 数 の 
関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 基 準 動作 の 追跡 と バラ ンス の 維持 を も た ら す 、 機 
械 的 人 エエ ー ジ ェ ン ト を 提供 する 。 

【0005】 

本 発明 の 別 の 態様 は 、 基 準 動作 に 対応 する 入力 デー タ を 受信 する ステ ッ プ と 、 複数 の 関 
節 を 介し て 結合 され た 複数 の 可動 部 分 を 有する 機械 的 人 工 エ ー ジ ェ ン ト の トラ ッ キ ング コ 
ント ロー ラ に バラ ンス 制御 信号 を 供給 する ステ ッ プ と 、 前 記 バ ラン ス 制 御 信号 に 基づい て 
バラ ンス を 維持 し な が ら 人 入力 基準 動作 を 追跡 する よう に 設定 され た 動作 命令 を 含む トラ ッ 
キン グ 制 御 信号 を 前 記 ト ラッ キン グ コ ント ロー ラ に よっ て 供給 する ステ ッ プ と を 備え 、 前 
記 複 数 の 関節 の 各々 が 前 記 動作 命令 を 使用 で き 、 基 準 動作 の 追跡 と バラ ンス の 維持 を も た 
ら す 、 方 法 を 提供 する 。 

【0006】 

本 発明 の 他 の 態様 は 、 一 つ 以 上 の プロ セッ サ と 、 複数 の 関節 を 介し て 結合 され た 複数 の 
可動 部 分 を 有する 機械 的 人 エエ ー ジ ェ ン ト の 動作 を 制御 する よう に 構成 され た コン ピュ ー 
タ 読 み 取 り 可 能 な プロ グラ ムコ ー ド を 有する プロ グラ ム 記 憶 装 置 と を 備え 、 前 記 コ ン ピ ュ 
ー タ 読み 取り 可能 な プロ グラ ムコ ー ド は 、 前 記 一 つ 以 上 の プロ セッ サ に より 実行 可能 で あ 
っ て 、 バ ラン ス 制 御 信号 を 供給 する よう に 設定 され た コン ピュ ー タ 読み 取り 可能 な コー ド 
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と 、 バ ラン ス 制 御 信号 に 基づい て バラ ンス を 維持 し な が ら 人 入力 基準 動作 を 追跡 する よう に 
設定 され た 動作 命令 を 生成 する よう に 構成 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ム 
コー ド と を 備え 、 前 記 複 数 の 関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 基 準 動作 の 追跡 と バ 
ラン ス の 維持 を も た ら す 、 装 置 を 提供 する 

[0007) 

本 発明 の 更に 他 の 態様 は 、 複 数 の 関節 を 介し て 結合 され た 複数 の 可動 部 分 を 有する 機械 
的 人 エエ エー ジェン ト の 動作 を 制御 する よう に 構成 され た コン ピュ ー タ 読み 取り 可能 な プロ 
グラ ムコ ー ド を 有する プロ グラ ム 記 憶 装 置 を 備え 、 前 記 コ ンピュータ 読み 取り 可能 な プロ 
グラ ムコ ー ド は 、 一 つ 以 上 の プロ セッ サ に より 実行 可能 で あっ て 、 バ ラン ス 制 御 信 号 を 供 
給 す る よう に 設定 され た コン ピュ ー タ 読み 取り 可能 な コー ド と 、 バ ラン ス 制 御 信 号 に 基 づ 
いて バラ ンス を 維持 し な が ら 人 入力 基準 動作 を 追跡 する よう に 設定 され た 動作 命令 を 生成 す 
る よう に 構成 され た コン ピュ ー タ 読み 取り 可能 な プロ グラ ムコ ー ド と を 備え 、 前 記 複 数 の 
関節 の 各々 が 前 記 動 作 命令 を 使用 で き 、 基 準 動作 の 追跡 と バラ ンス の 維持 を も た ら す 、 コ 
ンピュータ プロ グラ ム プ ロダ クト を 提供 する 
【0008】 

本 発明 の 他 の 特徴 及び 更 な る 特徴 及び 利点 と 一 緒 に 、 本 発明 の 模範 的 な 実施 例 の より よ 
i 本 発明 の 範囲 

は 添付 の 請求 項 に 特定 され て いる 。 
es 
【0009】 

【 図 1 】 本 発明 の 一 実施 例 に よる モー ショ ンコ ント ロー ラ を 示す 。 

【 図 2 】 本 発明 の 一 実施 例 に よる バラ ンス コン トロ ー ラ を 示す 。 

【 図 3 】 本 発明 の 一 実施 例 に よる バラ ンス コン トロ ー ラ の た め の 倒 立 振 子 モ デル を 示す 。 
【 図 4 】 本 発明 の 一 実施 例 に よる トラ ッ キ ング コン トロ ー ラ を 示す 。 

図 5 】COM 制 御 の み に よる 簡単 な バラ ンス 制御 中 ( 破線 ) 及び 本 発明 の 一 実施 例 に コ 
ント ロー ラ に よる バラ ンス 制御 中 ( 実践) の 前 面 方 向 の 重心 (COG) を 示す 。 

【 図 6 】 本 発明 の 一 実施 例 に よる コン トロ ー ラ に よる 簡単 な バラ ンス 制御 中 の 前 面 方 向 の 
圧力 中 心 (COP ) を 示す 。 
【 図 7 】 本 発明 の 一 実施 例 に よる COM 制 御 の み に よる 簡単 な バラ ンス 制御 中 の 前 面 方 向 
の COP 位置 を 示す 。 
【 加 8 】 本 発明 の 一 実施 例 に よる トラ ッ キ ング 及び バラ ンス 制御 を 示す 。 

【 図 9 】 本 発明 の 一 実施 例 に よる モー ショ ンコ ント ロー ラ を 示す 。 

【 図 1 0】 図 1 0 (a-c) は 足 持 ち 上 げ の 例 を 示し 、(aCOM オ フ セ ッ ト な し は 転倒 する こ 

と 、(b) 満 足 な 足 持 ち し 上げ は 適量 の COM オ フ セ ッ ト を 必要 と する こと 、(c) 大 きす ぎる オ 

フ セ ッ ト も 足 持ち 上 げ 後 に 転倒 する こと を 示す 。 

【 図 1 1 】 本 発明 の 一 実施 例 に よる 胴体 位置 及び 向き の 平行 移動 、 回 転 及 び ス ケー リン グ 
と 関連 する パラ メー タ を 示す 。 

【 加 1 2 】 本 発明 の 一 実施 例 に よる 修正 位置 を 得る 態様 を 示す 。 

【 加 1 3 】 本 発明 の 一 実施 例 に よる 右足 持ち 上 げに 対す る COM 及 び COP 軌 道 を 示す 。 
【 図 1 4 】 本 発明 の 一 実施 例 に よる コン ピュ ー タ シス テム を 示す 。 

【 発明 を 実施 する た め の 形 態 

[O010] 

本 発明 の 実施 例 の コン ポー ネン ト は 、 図 面 に 一 般 的 に 記載 され 示さ れる よう に 、 記 載 の 
実施 例 に 加え て 、 様々 な 異な る 構成 に 配置 し 設計 する こと が で きる こと は 容易 に 理解 され 
よう 。 従っ て 、 図 面 に 示さ れる 本 発明 の 実施 例 の 以下 の 詳細 な 説明 は 請求 の 範囲 で 請求 さ 
れる 本 発明 の 範囲 を 限定 する 意図 は な く 、 本 発明 の 模範 的 な 実施 例 を 例示 し て いる に すぎ 
な い 。 

【[0011]】 

本 明細 書 を 通し て 、「 一 実施 例 」 又 は 「 ある 実施 例 」( 又は 同類 の 表現 ) へ の 言及 は 、 

実施 例 と 関連 し て 記載 する 特定 の 特徴 、 構 造 又は 特性 が 本 発明 の 少な く と も 一 つの 実施 例 


と で 
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に 含ま れる こと を 意味 する 。 従っ て 、 明 細 書 中 の 種々 の 箇所 に お ける 「 一 実施 例 」、「 あ 
る 実施 例 」( 又は 同類 の 表現 は 必ず し も すべ て 同じ 実施 例 に 関連 する と は 限ら な い 。 
【0012】 

更に 、 記 載 す る 特徴 、 構 造 又は 特性 は 一 つ 以 上 の 実施 例 に お いて 任意 に 適切 に 組み 合わ 
せる こと が で きる 。 以下 の 説明 に お いて 、 本 発明 の 実施 例 の 全体 理解 を 与え る た め に 多く 
の 特定 の 詳細 な 記述 が 与え られ る 。 し か し 、 当 業者 は 、 本 発明 の 種々 の 実施 例 は 一 つ 以 上 
の 詳細 な 記述 が な く て も 、 他 の 方 法 、 コ ン ポ ー ネ ン ト 、 材 料 な ど を 用 いて 実施 する こと が 
で きる こと が 認識 され よう 。 更に 、 本 発明 の 特徴 が 不明 瞭 に な る の を 人 避け る た め に 周知 の 
構造 、 材 料 又は 動作 の 図示 や 詳細 な 説明 は 省略 され て いる 。 

【0013】 

本 発明 の 図示 の 実施 例 は 図面 を 参照 する こと に より 最も よく 理解 され よう 。 以下 の 説明 
は 例示 で あっ て 、 本 発明 の いく つか の 模範 的 な 実施 例 を 示し て いる だ け で ある 。 
【0014】 

図面 に 関し て は 、 図 の フロ ー チ ャ ー ト 及び 又は ブロ ッ ク 図 は 、 本 発明 の 種々 の 実施 例 
に よる シス テム 、 方 法 及 び コ ンピュータ プロ グラ ム プ ロダ クト の 可能 な 実施 の アー キテ ク 
チャ 、 機 能 及 び 動 作 を 示す 。 こ の 点 で 、 フ ロー チャ ー ト 又は ブロ ッ ク 図 内 の 各 ブ ロッ ク は 
モジ ュー ル 、 セ グ メ ント 又は 指定 の 論理 機能 を 実行 する 一 つ 以 上 の 実行 可能 な 命令 を 含む 
コー ド の 一 部 分 と する こと が で きる 。 ま た 、 い くつ か の 代替 実 施 例 に お いて は 、 ブ ロッ ク 
に 示す 機能 は 図 に 示さ れる 順序 と 異な る 順序 で 起こ り 得 る 点 に 注意 され た い 。 例え ば 、 順 
に 示さ れる 2 つの ブロ ッ ク は 実際 に は ほぼ 同時 に 実行 され る こと も あり 、 ま た これ ら の ブ 
ロッ ク は 関連 する 機能 に 応じ て 逆 の 順序 で 実行 され る こと も ある 。 ま た 、 ブ ロッ ク 図 及び 
グ 又 は フロ ー チ ャ ー ト の 各 ブ ロッ ク 有 及び ブロ ッ ク 図 及び 又は フロ ー チ ャ ー ト の ブロ ッ ク 
の 組み 合わ せ は 、 指定 の 機能 又は 動作 を 実行 する 専用 ハー ドウ ェ ア シ ステ ム 又 は 専用 ハー 
ドウ ェ ア と コン ピュ ー タ 命令 の 組み 合わ せ で 実現 で きる 点 に 注意 され た い 。 

【0015】 

本 明細 書 に 与え られ る 説明 は ヒュ ー マ ノ イド ロボ ッ ト 及 び ヒ ュー マン モー ショ ン キ ャ プ 
チャ に 重点 を 置く が 、 特許 請求 する 本 発明 は これ に 限定 され な い 点 に 注意 され た い 。 本 発 
明 の 実施 例 は 他 の タイ プ の 仮想 又は 機械 的 人 工 エ ー ジ ェ ン ト 、 ロ ボッ ト 及び 又は 入力 デ 
ー タ 源 に 等 し く 適 用 可能 で ある 。 

【0016】 

本 発明 者 は 、 特 に 自然 な 人 間 の 動作 を 実行 する よう に ロボ ッ ト を プロ グラ ミン グ す る こ 
と は 難し い 作 業 で ある こと を 認識 し た 。 ヒ ュー マ ノ イ ドロ ボッ ト は 、 動 力学 的 制約 及び 運 
動 学 的 制約 の 何れ か の 下 で 例え ば エネ ルギー 消費 を 最小 に する た め に 通常 手 作 業 で 又は 多 
く の 最適 化 技 術 に より プロ グラ ム さ れ て いる 。 モ ーション キャ プチ ャ デー タ は 潜在 的 に 良 
好 な 出発 点 で ある が 、 運動 学 及び 動力 学 パ ラメ ー タ の 差 の た め に キャ プチ ャ デー タ を 人 型 

ロボ ッ ト に マッ プ す る こと は 困難 で ある 。 実 際 上 、 ヒ ュー マン モー ショ ン キ ャ プチ ャ デー 
タ を 他 の ヒュ ー マ ノ イド モデ ル に マッ ピン グ す る 殆ど の 作業 は 全身 動力 学 が 通常 考慮 され 
な い グ ラフ ィ ッ クス 分 野 で 行わ れ て いる 。 

[O0017) 

現在 の ヒュ ー マ ノ イド ロボ ッ ト の 成功 例 の 殆ど は 、 最 初 に フッ ト プ リ ント に 基づい て 圧 
力 中 心 (COP 、 ゼ ロモ ー メ ント と し て も 知ら れ て いる ) 軌道 を 決定 し 、 倒 立 振 子 の よう 
な 簡易 動力 学 モデ ル を 用 いて 物理 的 に 整合 し た 重心 (COG) 軌道 を 生成 し 、 次 に 計画 さ 
れ た COG の 軌道 及び フッ ト プ リ ント を 満足 する 関節 角度 を 得る た め に 逆 運 動 学 (イン バ 
ー ス キネ マテ ィ ク ス ) を 計算 する こと に よっ て プロ グラ ム さ れる 。 あ る 研究 も バラ ン シ ン 
グ の た め に 倒立 振子 を 用 いて いる 。 こ れ ら の フレ ー ム ワー ク は 、 基 準 動作 が 物理 的 に 整合 
する こと が 保証 され る た め に 成功 し て いる が 、 一 般 に モー ショ ン キ ャ プチ ャ デー タ を 追跡 
する こと は で き な い 。 それは 、 計 画 さ れ た 軌道 の 上 に 基準 関節 軌道 を 付加 する こと は 物理 
的 整合 性 を 壊す 可能 性 が ある た めで ある 。 

【0018】 
ヒュ ー マ ン モー ショ ン キ ャ プチ ャ デー タ を ヒュ ー マ ノ イド ロボ ッ ト に 供給 する こと は 最 
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近 の 研究 の 成長 分 野 で ある が 、 こ れ ら の アプ ロー チ の 殆ど は フロ ー テ ィング ベー ス を 備え 
る リア ル ハ ー ド ウェ ア を 首尾 よく 制御 し て な い 。 殆ど の 研究 は ヒュ ー マ ン 動作 を ヒュ ー マ 
ノイ ドロ ボッ ト に 僅か な 自由 度 で マッ ピン グ し 、 ヒ ュー マン 動作 を ヒュ ー マ ノ イド 動作 の 
合成 の た め に 種々 の 動作 に 分 類する こと に 集中 し て いる 。 従来 の 研究 は 、 キ ャ プチ ャ し た 
上 半身 の 動作 を 関節 角度 及び 速度 限界 な どの 運動 学 的 制約 を 考慮 し て ヒュ ー マ ノ イド ロボ 
ッ ト に 適応 させ て いた 。 モー ショ シン キャブ チャ デー タ シ ー ケ ンス を フリ ー フ ロー ティ ング 
ヒュ ー マ ノ イド の 全身 動力 学 的 制約 を 満足 する よう に 変化 させ る こと が ロボ ッ ト 工学 及び 
グラ フィ ッ ク 工 学 に お いて 取り 組ま れ て いる が 、 こ れ ら の 努力 は プラ ン ニ ング に 集中 し て 
お り 、 妨 害 下 に お ける バラ ンス 回 復 の 問題 に 取り 組ん で いな い 。 

【0019】 

実際 に は 、 ヒ ュー マン モー ショ ン キ ャ プチ ャ デー タ に 基づい て ヒュ ー マ ノ イド ハー ドウ 
ェ ア を 制御 する こと に 成功 し た 研究 は ほとん ど な い 。 一 つの 従来 の 研究 は 、 ヒ ュー マン 動 
作 デ ー タ を 種々 の タス ク に 手 作 業 で セグ メン ト 化 し 、 各 タス ク の た め の コ ント ロー ラ を 構 
成す る こと に よっ て ロボ ッ ト ダ ンス 動作 を 実現 し て いる 。 別 の 従来 の 研究 は 、 逆 運動 学 計 
算 中 に 基準 関節 軌道 を 尊重 し な が ら COG 軌 道 を 倒立 振子 モデ ル に 基づい て 最適 化す る こ 
と に よっ て 物理 的 に 整合 し た 動作 を 生成 する 方 法 を 提案 し て いる 。 し か し 、 両 アプ ロー チ 
と も コン トロ ー ラ を 設計 する た め 又 は キャ プチ ャ デー タ を 前 処理 する た め に 手 作 業 を 必要 
と する 。 

【0020】 

ある 研究 は 全身 シミ ュ レ ーション 及び ハー ドウ ェ ア の 二 重 サ ポー ト 中 に 上 半身 の オン ラ 
イン トラ ッ キ ング を 実現 し て いる 。 し か し 、 こ の 研究 は 下半身 を バラ ン シ ン グ 専 用 に 使用 
する た め 、 脚 動作 の トラ ッ キ ング が バラ ン シ ン グ タ スク と 競合 し 、 脚 動作 を 完全 に は 追跡 
で き な い 。 

【0021】 

ここ で 説明 は 図面 に 戻り 、 本 発明 の 実施 例 を 選択 する 。 本 発明 の 種々 の 実施 例 の 以下 の 
説明 は 本 発明 の いく つか の 態様 を 強調 する た め に 提示 され 、 本 発明 の 範囲 は 添付 の 特許 請 
求 の 範囲 で 特定 され る 。 

【0022】 

本 発明 の 一 つ 以 上 の 実施 例 は 、 す べ て の 関節 を 同時 に 使用 し て 対象 の モー ショ ン キ ャ プ 
チャ デー タ を 追跡 する ヒュ ー マ ノ イド ロボ ッ ト 用 の 制御 フレ ー ム ワー ク を 提供 する 。 本 発 
明 の 実施 例 は 関節 角度 の 軌道 を 追跡 する こと に 重点 的 に 取り 組む が 、 い くつ か の タス ク は 
エン ド エ フ ェ ク タ の 軌道 の よう な 他 の 量 を 追跡 する こと を 要求 し 得る 。 本 発明 の 一 つの 実 
施 例 に よれ ば 、 コ ント ロー ラ は 二 重 サ ポー ト に て 働く が 、 バ ラン シン グ タ スク は 上 半身 の 
関節 も 含む すべ て の 関節 に 分 散 さ れる 。 更に 、 コ ント ロー ラ は モー ショ ン キ ャ プチ ャ デー 
タ の セグ メン ト 化 又は 集中 的 な 前 処理 を 必要 と せ ず 、 リ アル タイ ム ア プ リケーション に 適 
用 可能 で ある 。 更に 、 本 発明 の 別 の 実施 例 に よれ ば 、 足 踏み や も っ と 複雑 な 動作 が 可能 で 
ある 。 

[0023) 

本 発明 の 一 実施 例 に よれ ば 、 コ ント ロー ラ は バラ ンス コン トロ ー ラ と トラ ッ キ ング コン 
トロ ー ラ の 2 つの コン ポー ネン ト を 備え る 。 バ ラン スコ ント ロー ラ は 、 ロ バス ト な バラ ン 
スコ ント ロー ラ の 設計 が 容易 に で きる 簡易 モデ ル を 用 いる こと に よっ て 全身 を バラ ンス し 
た 状態 に 維持 する よう に 試み る 。 代表 的 な 非 限定 例 は 線形 二 次 レ ギュ レー タ (LQR) を 
備え る 倒立 振子 で あり 、 こ こ に 提示 され る 非 限定 模範 実施 例 に 使用 され る 。 バラ ンス コン 
トロ ー ラ は 簡易 モデ ル を バラ ンス し た 状態 に 維持 する た め に 所 望 の 入力 を 与え る 。 こ の よ 
うな 入力 の 例 は 圧力 中 心 (COP ) 及び 代表 的 な 関節 の トル ク を 含む 。 

【0024】 

本 発明 の いく つか の 実施 例 に よれ ば 、 ト ラッ キン グ コ ント ロー ラ は 、 バ ラン スコ ント ロ 
ー ラ に より 与え られ る 所 望 の 入力 を 尊重 し な が ら 、 関 節 が モー ショ ン キ ャ プチ ャ デー タ に 
より 指定 され る 基準 軌道 を 辿る よう に する 。 関 節 軌道 トラ ッ キ ング は 、 関 節 角 度 及び 速度 
に 基づい て 所 望 の 関節 加速 度 及 び フ ィ ー ド フォ ワー ド 関 節 加 速度 を 命令 する こと に よっ て 
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可能 に な る 。 次 に トラ ッ キ ング コン トロ ー ラ は 、 所 望 の 入力 及び 関節 加速 度 か ら の 誤差 を 
含む 二 次 コ スト 関数 を 用 いて 最適 化 問 題 を 解く 。 
【0025】 

本 明細 書 に お いて 、 関 節 速 度 及 び ト ルク 限界 を 考慮 に 入れ る 全身 動力 学 的 シミ ュ レ ー シ 
ョ ン に よっ て コン トロ ー ラ の バラ ン シ ス 及び 追跡 能力 が 証明 され る 。 基本 的 な バラ ンス 能 
力 を 示し た 後に 、 非 限定 的 な 代表 的 使用 例 が 与え られ る 。 こ の 使用 例 で は 本 発明 の 一 実施 
例 に よる コン トロ ー ラ が 同じ スト ー リ ー を 話し て いる 2 人 の 対象 の モー ショ ン キ ャ プチ ャ 
クリ ッ プ を 追跡 する の に 適用 され る 。 本 明細 書 に 示さ れる よう に 、 得 られ る ロボ ッ ト 動作 
は 各 対 象 の 元 の スタ イル を 明確 に 保つ 。 本 発明 の 実施 例 の ロバ スト 性 も シミ ュ レ ーション 
モデ ル の 慣性 パラ メー タ を 乱す こと に よっ て 証明 され る 。 その後 、 足 踏み 及び も っ と 複雑 
な 動作 の 追加 も 記載 され る 。 

【0026】 

コン トロ ー ラ 
【0027】 

図 1 は 本 発明 の 一 実施 例 に よる コン トロ ー ラ 1 00 の 概略 図 を 示す 。2 つの 主 な コン ポ 
ー ネ ン ト は バラ ンス コン トロ ー ラ 1 0 1 と トラ ッ キ ング コン トロ ー ラ 1 0 2 で ある 。 バラ 
ンス コン トロ ー ラ 1 0O 1 は 、 簡易 動 力学 的 モデ ル に 対し て 設計 され た コン トロ ー ラ 、 例 え 
ば 線形 倒立 振子 モデ ル に 対す る L QR を 用 いて 全身 を バラ ンス し た 状態 に 維持 し な けれ ば 
な ら な い 。 バ ラン スコ ント ロー ラ 1 0 1 の 出力 は 簡易 モデ ル へ の 所 望 の 入力 、 例 えば 圧力 
中 心 及 び / 又 は 代表 的 な 関節 の トル ク で ある 。 ト ラッ キン グ コ ント ロー ラ 1 0 2 は すべ て 
の 関節 を 所 望 の 軌道 に 追従 させ な けれ ば な ら な い 。 ト ラッ キン グ コ ント ロー ラ 1 02 は 関 
節 ト ラッ キン グ と 簡易 モデ ル へ の 所 望 の 入力 の 両方 を 尊重 する 最適 化 問 題 を 解き 、 ロ ボッ 
ト 1 03 へ 命令 すべ き 関 節 ト ルク を 得る 。 

【0028】 

モー ショ ン キ ャ プチ ャ デー タ 処 理 
【0029】 

この 説明 の た め に 、 典 型 的 に は 直交 座標 空間 内 の 一 組 の マー カー 軌道 を 含む 基準 動作 デ 
ー タ (例え ば モー ショ ンク リッ プ 1 04 ) を 得る た め に 市 販 の 光学 モー ショ ン キ ャ プチ ャ 
シス テム を 用 いる も の と 仮定 する 。 マ ー カ ー デ ー タ は 通常 の モー ショ ン キ ャ プチ ャ パイ プ 
ライ ン 内 で ラベ ル 付 けさ れ 、 ク リー ニン グ さ れる 。 次 に デー タ は 特定 の ロボ ッ ト ( 1 03 
) の サイ ズ に 合う よう に スケ ー リ ング され 、 関 節 動作 範囲 を 考慮 し て 逆 運動 学 アル ゴリ ズ 
ム に より ロボ ッ ト 1 03 の た め の 関 節 角 度 デ ー タ に 変換 され る 。 関節 限界 及び 対象 と ロボ 
ッ ト 1 03 と の 運動 学 の 差 の た め に 、 関 節 角度 デー タ は 通常 、 接 触 点 に お ける フッ トス ケ 
ー テ ィング の よう な 問題 を 有する 。 

[0030) 

前 処理 の た め に 、 こ こ で は 、 本 例 は 最初 の フレ ー ム に お いて 両足 が 床 の 上 に 平ら に 着い 
て いる も の と 仮定 する 。 正しい 足 位 置 及 び 向 き は 、 生 の マー カー デー タ を 用 いて 得 ら れる 
足 位置 及び 向き を 床上 に 投影 する こと に よっ て 推定 され る 。 ( 足踏み 及び 他 の 複雑 な 動作 
を 含む 実施 例 が 以下 に 記載 され る ) 。 次 に 、 ク リー ニン グ さ れ た 関節 角度 を 得る と と も に 
元 の 関節 角度 か ら の 差 を 保持 する た め に 新しい 足 位 置 に 対す る 逆 運 動 学 が 計算 され る 。 制 
御中 の 各 フ レー ム に お いて 、 ク リー ニン グ さ れ た 関節 角度 を 得る た め に この 差 が 元 の デー 
タ に 付加 され る 。 こ の 補正 は きわ め て 簡単 で ある が 、 本 発明 の この 模範 的 な 実施 例 に よる 
コン トロ ー ラ が 更 な る クリ ー ン アッ プ を 必要 と し な いよ うに で きる 。 

【0031】 

記号 の 説明 と 基本 方 程 式 

[0032) 
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Nj は ロボ ッ ト の 駆動 され る 関節 の 数 を 示す 。 こ の 場合 、 コ ボッ ト の 総合 自由 
度 (DOF) は 、 根 関節 の 平行 移動 及び 回 転 の 6 DOF を 含め て 、Ne=Ni 十 6 


Nc 
で ある 。 ロボ ッ ト コ ン フ ィ ギ ュ レ ー シ ョ ン は 一 般 化 座標 い に より 一 意 に 


Ng 
規定 され 、 そ の 最初 の 6 成分 は 根 関節 に 対応 する 。 ー 毅 化 カ は oeA に よ 
り 示 され る 。 


【0033] 


ヒュ ー マ ノ イド ロボ ッ ト は 通常 、 そ の リン ク の いく つか が 外界 と 接触 し て 動 
く 。Nc は 接触 する リン ク の 数 を 示す も の と する 。 i 番 の 接触 リン ク の 線 速 度 及 
び 角 速度 は 6 次 元 ベ クト ル @ に より 表 さ れる 。 一 般 化 速 度 及び "ci の 関係 は 、 


し キア 1 ① 


Je ANG 
と し て 表 さ れる 。 こ こ で 、 は 、 一 般 化 座標 に 対す る i 番 接触 リン ク 


の 位置 及 び 向 き の ヤ ュ ビ アン 行列 で ある 。 方程式 (1 ) を 微分 する と 、 加 速度 
の 関係 が 得 られ る 。 


a ② 
合成 接触 ヤ コ ビ アン マ 行 列 J 。 は 、 
J 


cl 
J . 
| em ew. (3) 


J 


に より 定義 され る 。 


【0034】 


根 関節 は 腕 動 され な いた め 、 関 節 ト ルク ベク トル EA 。 のみ が 制 


御 さ れる 。 更に 、 外 界 と 接触 する Nc 個 の リン ク の 各々 は 接触 力 f 。 及 び リ ンク 
ロー カル フレ ー ム 周囲 の モー メン ト n。』 (12…,Nc) を 受け る 。 合成 接触 カノ 


了 7， アー テア 7 6 が 
ww nn “ee n eA で ， 
モー メン ト は 、 Te = Ua ra me) で 定義 され る 。 


[O035] 
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ロボ ッ ト の 動作 の 方 程 式 は 、 
.My+c=N't ,+ . G4) 


Mx 
と し て 表わさ れる 。 こ こ で 、 MM eA 0 ュ 関 節 一 空間 慣性 行列 で あり 、 


ル NjxNG 
ceA "は コリ オリ カ 、 遠心 力 及び 重力 の 和 で ある 。 行列 NE 


は 関節 トル ク を 一 般 化 力 こ に マップ する た め に 使用 され 、 次 の 形 を 有する 。 


ここ で 、0.。 及 び 1 , は 下 付き 文字 で 示さ れる サイ ズ の ゼロ 行列 及び 単位 行列 で 
ある 。 


【0036】 

バラ ンス コン トロ ー ラ 
[0037) 

図 2 は 本 発明 の 一 実施 例 に よる バラ ンス コン トロ ー ラ 2 0 1 の 構造 を 示す 。 バ ラン スコ 
ント ロー ラ 20 1 は 2 つの 主 な コン ポー ネン ト 、 即 ち バ ラン ス を 維持 する た め に 簡易 モデ 
ル へ の 入力 を 計算 する よう に 構成 され た レギ ュ レ ー タ 201a と 、 測 定 に 基づい て 現在 の 
状態 を 推定 する よう に 構成 され た オブ ザー バ 201b と か ら な る 。 簡易 モデ ル は ( 例え ば 
ヒュ ー マ ノ イド ロボ ッ ト の ) 動力 学 を 表す 限り 、 任 意 の も の を 用 いて バラ ンス コン トロ ー 
ラ 201 を 設計 する こと が で きる 。 代表 的 な 例 は 線形 倒立 振子 で あり 、 レ ギュ レー タ 2 0 
1 a は こと の モデ ル に 対し て ポー ル 配 置 又は 最適 制御 に より 容易 に 設計 する こと が で きる 。 
【0038】 

基準 状態 及び 測定 され た 入力 に 基づく 簡易 モデ ル の 現在 状態 の 推定 に 関す る いく ら か の 
詳細 を 与え る た め に 、 非 限定 例 を 以下 に 示す 。 簡易 モデ ル は 線形 で あり 、 状 態 - 空間 微分 
方 程 式 : 


【 数 1 】 
X= Ax+ Bu (6) 
y=Cx (の 


で 表 さ れる 。 こ こ で 、x は 簡易 モデ ル の 状態 、u は 入力 、y は 出力 で ある 。 ま た 、 バ ラン 
ス の た め の 状 態 帰 還 コ ント ロー ラ は 次 の よう に 設計 され て いる も の と する 。 

u ニ K(x』-x) ( 8) 
ここ で 、K は 一 定 の 利得 行列 で あり 、x 。 は 代表 的 に は 基準 動作 か ら 計 算 さ れる 基準 状 
態 で ある 。 
【0039】 
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オプ ザー バ 2 0 1 b は 推定 及び 実際 の 出力 を 比較 し て 推定 状態 x ^ を 、 


$= At+ But+F(D—y) (9) 


と し て 更新 する 。 ここ で 、F は オプ ザー パ 利 得 、y “= C x は 推定 出力 で ある 。 
実状 態 は ほ ア デア クセス で き な い た め 、 方程式 (8) に お いて 状態 x は その 推定 値 x 
と 購 き 換え られ 、 


ん = だ ( テ レージ) (10) 
に な る 。 方 程 式 (6 )、(7)、(9) 及 び (1 0) を 用 いる と 、 推 定 状態 及び 新しい 
スカ アア 下記 の シス テム が 得 ら れる 。 


= A + Bu, (11) 


【0040】 

方 程 式 ( 1 1 ) は 簡易 モデ ル の 現在 状態 を 基準 状態 及び 測定 出力 に 基づい て 推定 する 方 
法 を 記述 し て いる 。 推定 状態 及び 方 程 式 ( 1 0 ) に より 計算 され る 簡易 モデ ル へ の 入力 を 
ドラ ッ キ シダ コン トロ ー ラ 1 02 へ の 入力 と し て 使用 ずる こと が で きる 。 

【0041 

倒立 振子 例 
【0042】 

ここ で は 、 簡易 モ デル と し て 線形 倒立 振子 を 用 いる バラ ンス コン トロ ー ラ ( 例え ば 図 2 
に 示す バラ ンス コン トロ ー ラ 20 1 ) の 一 例 が 提示 され る 。 図 3 を 参照 する と 、2 つの ア 
クティ ブ 線 形 関節 (それ ら の 位置 及び アク チュ エー タカ は (x, y) 及び (ff,, f ,) で 
表 さ れ て いる ) と 、2 つの 不作 動 関節 ( それ ら の 関節 角度 は の 及び の: で ある ) と 、 質 点 
m が 示さ れ て いる 。 線形 関 節 の 位置 及び 質点 は 全身 モデ ル の COP 及 び COM に それ ぞ れ 
対応 する 。 線形 化 後 に 、 こ の 倒立 振子 は 関節 (x , 9:) 及び (y , 9 の) を 有する 2 つの 
独立 の 平面 振子 と し て 取り 扱う こと が で きる 。 従っ て 、 説 明 用 の 例 と し て (x , 6@:) を 
有する 振子 を 用 いる 。 

【0043】 

その 状態 は 線形 倒立 振子 の 入力 及び 出力 ベク トル で 次 の よう に 規定 され る 。 

【 数 2 】 


x=(x 8 i 8 (12) 


wf (13) 


y=(x 10) . (14) 
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【0044]】 

質点 の x 座標 が の 9」 の 代わ り に 出力 と し て 使用 され る 点 に 注意 され た い 。f , は 倒立 振子 
へ の 実際 の 入力 で ある が 、 全身 モデ ル に は 対応 する 入力 は な い 。 代わ り に 、 全 身 モ デル の 
COP は どこ に ある べき か を 示す x が 所 望 の 入力 と し て 使用 され る 。 所 望 の 入力 の 他 の 可 
能 な 例 は 、 科 易 モ デル が 2 重 倒立 振子 の よう に アク ティ ブ 回 転 関節 を 含む 場合 に は 、 代 表 
的 な 関節 の トル ク を 含む 。 

【0045】 


この 倒立 振子 モデ ル の 基準 状態 は 


x =(x 000 
wy =e 000) で あり 、 こ こ で x,。 は 基準 関節 角度 か ら 計 算 き れる COM 位 


置 の x 座 標 で ある 。 測 定 出力 y は 実際 の COP 及 び COM 位 置 の x 座標 か ら な 
る 。 


【0046】 

次 に 、 レ ギュ レー タ が 倒立 振子 に 対し て 設計 され る 。 こ こ で は LQR を 使用 し 、 以 下 の 
コス ト 関数 が 最小 化 さ れる よう に 状態 帰 本 利得 K を 決定 する 。 

【 数 3 】 


7= [TQ, tu Ru)dt (15) 


ここ で 、Q 和 =O 及 び R >0 は 対称 加重 行列 で ある 。 加重 行列 は 妨害 に 対す る 応答 を 観測 す 
る こと に よっ て 容易 に 決定 で きる 。 例え ば 、 加 重 は 、 可 能 な 最大 外部 力 が 供給 され た と き 
に 所 望 の COP が 接触 域 か ら 出 な いよ うに 決定 する こと が で きる 。 

【0047】 

トラ ッ キ ング コン トロ ー ラ 
【0048】 

図 4 は 本 発明 の 一 実施 例 に よる トラ ッ キ ング コン トロ ー ラ 402 の 構造 を 示す 。 ト ラキ 
ング コン トロ ー ラ 402 は 2 つの 局部 コン トロ ー ラ 402a , 402b と 、 関 節 ト ルク 最 
適 化 モジ ュー ル 402c と か ら な る 。 

【0049】 


局部 コン トロ ー ラ 

本 発明 の いく つか の 実施 例 に よれ ば 、 局 部 コン トロ ー ラ 402a, 402b 
は 、 関 節 及び 接触 リン ク の 所 望 の 加速 度 を 基準 及び 現在 の 位置 及び 速度 並び に 
基 准 加速度 に 基づい て 計算 する 。 関節 コン トロ ー ラ 4 0 2 a に お いて 、 所 望 の 


加 速度 が 各 関節 で 次 の よう に 計算 され る 。 
= +i dg の すん (9 -9) (16) 


ここ で 、q は 現在 の 関節 位置 、qrss は キャ プチ ャ デー タ 内 の 基準 関節 位置 、k。 
及び jka は 関節 毎 に 相違 し 得る 一 定 の 位 二 利得 及び 速度 利得 で ある 。 


[O050] 
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概 関 節 の 位置 及び 向き は 加速 度 計 及び ジャ イロ セン サ に よっ て 又は 少な く と 
も 一 方 の 足 が 床 の 上 に ある と 仮定 し て 運動 学 を 計算 する こと に よっ て 入手 で き 
る も の と する こと が で きる 。 そ れ ゆ え 、 根 関節 の 所 望 の 線 及び 角 加 速度 を 計算 
し 、 す べ て の 所 望 の 関節 加速 度 と 合成 し て 所 望 の 加速 度 ベ クト ル 


A 

の を 形成 する こと が で きる 。 制 御 法 則 (1 6 ) は 、 根 関節 が 駆動 され な 
いこ と 及び 所 望 の 加速 度 は 最適 化 部 ( 後 で 説明 され る ) に より 修正 され 得る こ 
と を 除い て 、 分 解 加 速度 制御 に 使用 きれ る も の と 同じ で ある 。 足 を 滑ら さ ず に 、 
で きれ ば 所 望 の 接触 状態 を 実現 する た め に 、 同 じ 制 御 法 則 を 用 いて 所 望 の 足 加 


と ^ ON, 

速度 “cEA "も 計算 する こと が で きる 。 
【0051 

最 通化 器 
[O0052] 

最適 化 器 4 0 2 c の タス ク は 、 これ まで 得 ら れ た 情報 の 及び パラ ンス コン 
トロ ー ラ 2 0 1 に より 得 ら れ た 簡易 モデ ル へ の 所 望 の 入力 に 基づい て 制御 入力 
を 計算 する こと に ある 。 し か し 、 殆 どの 場合 、 こ れ ら の 状態 は 互い に 競合 する 。 
その ゆえ 、 こ れ ら の 基 の すべ て を 尊重 する 一 組 の 関節 トル ク を 計算 する た め に 


最適 化 が 実行 され る 。 


[O053] 
最適 化 の 未知 量 は 関節 トル ク t 及び 接触 力 f . で ある 。 最適 化す べき コス ト 関数 は 、 


Z=Z.+Zs+Z。+Z:+Z: (17) 
で あり 、5 つの 項 の 各々 は 以下 の 段落 で 詳細 に 説明 され る 。 


【0054】 
项 Z 。 は 簡易 モデ ル へ の 所 望 の 入力 か ら の 誤差 に 対処 する も の で ある 。 簡易 モデ ル か ら 


全身 モデ ル へ の マッ ピン グ は 任意 の 形 で で きる た め 、 こ こ で は この よう な マッ ピン グ の 2 
つの 例 、 即 ち 圧 力 中 心 (COP ) 及び 代表 的 関節 の トル ク の マッ ピン グ を 考察 する 。 
場合 、 コ スト 関数 Z 。 は これ ら の 量 と 関連 する 誤差 の 和 に な る 。 即ち 、 

Z .=e +e， (18) 

【0055】 


この 
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r 
最初 に 、 所 望 の 入力 が CO P の 所 望 の 位置 ?一 (Pr mp 0) と る 場合 を 考え 
る 。COP 有 誤差 は 、 


ecor "> た だ が (19) 
と 表せ る 。 こ こ で 、P は f 。 を 所 望 の COP の 周り の 合成 モー メン ト ヘ マッ プ す 


る 行列 で あり 、 次 の よう に 計算 する こと が で きる 。 最 初 に 、 個 々 の 接 態 力 か ら 
ワー ルド 原点 の 周り の 総合 接触 力 及び モー メン ト を カバ ー す る 行列 


Te AS を 、 
T= (TT,... Twe) (2 0) 
及び 
ls 0 : 。 
Tx 
5 fe 


に よっ て 得る 。 こ こ で 、p。 は i 番 接触 リン ク の 位置 で あり 、[ a X] は 3 次 元 
ベク トル a の 外 積 行列 で ある 。 次 に 、 下 記 の 行列 : 


00m 100 
ec-[。 0 2。 91 | 「 2) 


Er 


を 乗算 する こと に よっ て Pー ニ CT を 生じ させ 、 総 合 カ プ モ ー メ ント を COP の 
周囲 の 合成 モー メン ト に 変換 する 。 


[0056]】 


NM, 
所 望 の 入力 が N 。 個 の 代表 的 関節 の トル ク を 含む 場合 、 Ap る に 
ら な い 。 


Nean, 
で な から 代表 的 関節 の トル ク を 抽出 する 行列 で ある と し よう 。 誤 
差 は 、 
_ 
= rR YW, -R ,). @3) 
と 書き 表せ る 。 
【0057】 


項 Z 。 は 所 望 の 関節 加速 度 か ら の 誤差 を 示し 、 
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【 数 4 】 
下 TH 
ニュ (9ー の "所 (9- の - (24) 
で ある 。 
【0058】 
項 Z 。 は 所 望 の 接触 リン ク 加 速度 か ら の 誤差 を 示し 、 
【 数 5 】 
Z.=3 ②) 
で ある 。 
【0059] 
项 Z ,法 、 
る = Et) (26) 


と 書き 表 さ れ 、 こ こ で 、? ァ は 関節 トル ク に 対す る 基準 で あり 、 典型 的 に は ゼロ 
ペク トル に 設定 され 、 従 っ て Z 、 は 関節 トル ク に 対し て 減衰 項 と し て 作用 する 。 


【0060】 
项 Z , は 接触 力 に 対し て 同様 の 役割 を 有 し 、 


1 .^ ^ 
= テー Wf) G の 
で あり 、 ここ で 7 は 基準 接触 力 で あり 、 同様 に 典型 的 に は ゼロ ベク トル に 設定 
され る 。 


【oo61】 
コス ト 関 数 は 方 程 式 (2) 及び (4) を 用 いて 次 の 二 次 方 程 式 : 


2= ュ ア イル キア の +c (28) 
y=(t7—f) 
に 変換 する こと が で き 、 こ こ で 、 は 未知 の ベク トル で ある 。 


【0062】 
最適 化 問 題 は 解析 解 : 
y=-A 'b (29) 
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を 有する 。 
【0063】 

接触 力 及び ハー ドウ ェ ア 限 界 の 考察 
【0064】 

今 ま で 、 人 任意 の 接触 力 が 得 ら れる と 仮定 し て きた 。 し か し 、 実 際 に は 、x 及び y 軸 の 周 
囲 の 摩擦 及び モー メン ト は 制限 を 有する 。 実 際 の ハー ドウ ェ ア も 関節 角度 、 速 度 及び トル 
ク に 制限 を 有する 。 こ れ ら の 制限 を 実行 する た め に 不等式 制約 を 付加 する こと が で きる が 
、 最適 化 問 題 を 解く に は 単に 方 程 式 ( 2 9 ) を 用 いる 場合 より か な り 長 い 時 間 が か か る こ 
と に な る 。 

【0065】 

これ ら の 制限 は 、 本 発明 の 実施 例 に よれ ば 、 制 約 を 付加 する 代わ り に 最適 化 の パラ メー 
タ を 調整 する こと に よっ て 、 従 っ て 解 (29) を 変更 する こと な く 、 処 理 さ れる 。 制限 が 
必ず し も 満た され る わけ で は な い 場 合 に は 、 バ ラン スコ ント ロー ラ は 近似 値 と 正確 な 解 と 
の 差 を 補償 で きる こと が 期待 され る 。 

【0066】 

接触 力 制限 に 対し て は 、 摩擦 及び モー メン ト に 対応 する W, の 要素 に 対し て 大 き な 値 が 
設定 され る 。 関節 トル ク 限 界 に 対処 する た め に 、 方 程 式 ( 2 6 ) で 用 いら れ て いる 基準 関 
節 ト ルク を 利用 する 。 関節 トル ク の どれ か が サン プリ ング 時 に 限界 値 を 超え る 場合 に は 、 
対応 する 基準 トル ク が 次 の サン プリ ング 時 に 限界 値 に 設定 され 、 加 重 を 増大 する 。 そ れ ゆ 
え 、 ト ルク が 限界 値 で 飽和 され て も 、 過 剰 ト ルク は 比較 的 小さ く 、 従 っ て 僅か な 影響 と な 
る こと が 予想 され る 。 

【0067】 

シミ ュ レ ーション 結果 
【0068】 

本 発明 の 所 定 の 実施 例 を 評価 する た め に 、 鋼 体 接触 モデ ル を 備え た 動力 学 シ ミュ レー タ 
を シミ ュ レ ーション に 使用 し 、 そ の 精度 を いく つか の シミ ュ レ ーション 設定 に 対し て 証明 
し た 。 シ ミュ レー ショ ン の た め に ヒュ ー マ ノ イド ロボ ッ ト を 使用 し た 。 ロ ボッ ト は 全部 で 
34 の 関節 ( 手 及び 眼 の パン プチ ルト は 除く ) を 有 し 、 こ れ ら の 関節 ( 首 及び 手首 の DO 
F は 固定 ) の うち の 25 の 関節 を 本 発明 の 種々 の 実施 例 の 性 能 の 非 限定 例 と し て ここ に 記 
載 す る 評価 の た め に 使用 し た 。 

【0069】 

関節 運動 学 及び 慣性 パラ メー タ は CAD モ デル か ら 導 出し た 。 関節 速度 限界 に 対す る 設 
計 仕 様 に 加え て 、 実 験 的 に 検証 し た 関節 動作 範囲 及び 関節 トル ク 限 界 情報 を 使用 し た 。 関 
節 動作 範囲 制約 は 逆 運 動 学 計算 中 に 実行 し た が 、 関 節 動作 範囲 は シミ ュ レ ーション に 考慮 
され て な い ( 関節 は 基準 軌道 を 十分 良好 に 追跡 する も の と 仮定 し た ) 。 関節 速度 が 限界 値 
に 近づく と 、 速度 を 下げ る た め に 強い 減衰 トル ク が 付加 され た 。 最適 化 さ れ た 関節 トル ク 
が 限界 値 を 超え る と 、 シ ミュ レー タ が 関節 加速 度 を 計算 する 前 に この トル ク は 最大 値 に リ 
セッ ト さ れ た 。 

【0070】 

LQR コ スト 関数 ( 1 5 ) に 対す る 加重 は 、 

Q = diag{ 1.0x 10 1.0x 10 1.0x 10 1.0X 10} 

R =1.0 
で あり 、 こ れ ら は COP が 大 き な 衝 撃 に 対し て 接触 域 か ら 出 な いよ うに 選択 され た 。 オ ブ 
ザー バ 利 得 は 、 推 定 状態 が 閉 ル ー プ の 極 に 比較 し て 十分 に 速く 収 仏 さ れる よう に 選択 し た 
。 関節 及び 接触 リン ク 追 跡 の ため の 帰還 利得 は 、 他 に 言及 し な い 限 り 、k 。=4.0 及 び k 。 
デニ 4.0 と し た 。 コ スト 関数 に 対し て 選択 され た すべ て の 加重 は 、W, 及 び W。 を 除い て 、 
すべ て の 対 角 要 素 が 1 と し た 。 Wi の 対 角 要 素 は デフ ォ ル ト に より 0 に 設定 され 、 関 節 ト 
ルク が 限界 値 を 超え た と き 、 対 応 す る 値 が 1 に 変化 し た 。W。 の 対 角 要 素 は 垂直 力 及び 他 
の 力 に 対し て それ ぞ れ 1.0x 10 及び 1X 10 に 設定 し た 。 

【0071】 
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倒立 振子 モデ ル に よる 簡単 な バラ ン シ ン グ 
【0072】 

ここ で は 最初 に 固定 の 姿勢 を 基準 と し て 用 いて バラ ンス コン トロ ー ラ 201 の 基本 機能 
を 実証 する 。 ロ ボッ ト は 、 初 期 姿 勢 を 維持 し よう と し な が ら 首 関節 に t =1 ~1 . 1 秒 の 
間 2 5 0N の 力 を 受け た 。 参照 用 に 、 僅 か に 異な る バー ジョ ン の コン トロ ー ラ 1 00、 即 
ち バ ラン スコ ント ロー ラ が 同じ 帰還 ププ フィ ー ド フォ ワー ドコ ント ロー ラ ( 1 6 ) 及び 同じ 
利得 で COM 位 置 を 元 の 位置 へ 戻す た め の 所 望 の COM 加 速度 を 計算 する 簡単 な COM 位 
置 コ ント ロー ラ と 置き 換え られ た コン トロ ー ラ を 使用 し た 。 こ の 場合 、 最 適 化 器 402c 
は 所 望 の COP 位 置 の 変わ り に 所 望 の COM 加 速度 に 対応 する 。2 つの コン トロ ー ラ は 同 
じ 関 節 及 び 接 触 リ ンク 追跡 コン トロ ー ラ を 共有 する 。 

[0073) 

図 5 は 2 つの コン トロ ー ラ か ら 得 られ る ロボ ッ ト の 順 方 向 の COM 位 置 を 示す 。 本 発明 
の 一 実施 例 に よる コン トロ ー ラ は ロボ ッ ト を 首尾 よく 元 の 姿勢 に 戻し た 。 他方 、COM コ 
ント ロー ラバ ー ジ ョ ン は 本 発明 に よる コン トロ ー ラ より か な り 早 く COM を 停止 させ た が 
、 ロ ボッ ト は 最終 的 に 後ろ に 倒れ た 。 そ の 理由 は 、COM コ ント ロー ラバ ー ジ ョ ン は CO 
M 動 作 を 止め る こと が で きる が 、 そ の アク ショ ン は 上 半身 の 前 方 へ の 急速 動作 を 犠牲 に し 
、 上 半身 の 回 復 動作 の 補償 を 得る こと が で き な い こと に ある 。 こ の 誤差 は 関節 及び COM 
帰還 利得 を 調整 する こと に よっ て 修正 で きる 可能 性 が ある 。 

【0074】 

提案 の コン トロ ー ラ 及び COM コ ント ロー ラバ ー ジ ョ ン に よる COP 位置 が それ ぞ れ 図 
6 及び 図 7 に 示さ れ て いる ( 重要 部 分 を 強調 する た め に 図 5 に 比較 し て 異な る 時 間 ス ケー 
ル ( 2 秒 ) を 使用 し て いる ) 。 図 6 に お いて 、 所 望 の COP 及 び 最 適 化 COP は 殆ど 同一 
で あり 、 実 際 の COP も 極め て 近似 し て いる 。 図 7 に も 、 所 望 の COP 位置 、 最 適 化 CO 
P 位置 及び 実際 の COP 位 置 が 示さ れ て いる 。 こ こ で 、 所 望 の COP を 考慮 し な けれ ば 、 
実際 の COP も COM に 負 の 加速 度 を 与え る た め に 前 方 に 動く が 、 動 作 は 結局 全 シ ステ ム 
を 平衡 させ る た め に 多大 な 制御 を 使用 し な けれ ば な ら な く な る ほど 速く な る 。 
【0075】 

モー ショ ン キ ャ プチ ャ 基準 の 追跡 
【0076】 

本 発明 の 特定 の 実施 例 の ロボ ッ ト 動作 追跡 性 能 を 評価 する た め に 、 関 節 追 跡 能 力 が 重要 
で ある スト ー リ ー テ リン グ 動 作 を 使用 し た 。CMU モ ーション キャ プチ ャ デー タラ イブ ラ 
リ か ら 保育 テー マ 「 私 は 小さ な ティ ー ポ ッ ト 」 を 演ずる 2 人 の アク タ の モー ショ ン キ ャ プ 
チャ クリ ッ プ を 入力 と し て ラン ダム に 選択 し た 。 コ ント ロー ラ は 元 の (対象 の ) 動作 ( 図 
示せ ず ) の 姿勢 を 保存 する ロボ ッ ト 動 作 を 再現 する こと が で きた 。 


[0077) 
妨害 の 例 : 質量 パラ メー タ の 誤 
【0078】 


本 発明 の 一 実施 例 に よる シミ ュ レ ーション モデ ル の 慣性 パラ メー タ を 、( ワイ ヤ な どの 
小 部 分 及び 油圧 ロボ ッ ト に お ける シリ ンダ や 管内 の 油 の 有意 の 質量 を 一 般 に 無視 する ) C 
AD モデ ル を 用 いる こと に よる モデ ル 化 誤差 を エミ ュ レ ー ト する た め に 動揺 させ た 。 各 リ 
ンク の 質量 及び 慣性 は シミ ュ レ ーション モデ ル に お いて 5 一 1 5 % の ラン ダム 比 だ け 増 大 
させ た 。 制御 の た め の 基 準 モ デル は 同じ まま に し た 。 推定 接触 力 は 常に 実際 の 力 よ り 小 さ 
いた め 、 ロ ボッ ト は 元 の 利得 ( k 。 ニ 4.0, k 。=4.0) で 立ち 続け る こと は で き な い 。 し 
か し 、 図 1 1 に 示す よう に 、 利 得 を 増大 させ て k 。=16.0, k 。=8.0 を 維持 する こと に よ 
っ て 類似 の 動作 を 首尾 よく 発生 させ る こと が で きた 。 

【0079】 

従っ て 、 本 発明 の 実施 例 は フロ ー テ ィング ベー ス の ヒュ ー マ ノ イド ロボ ッ ト が バラ ンス 
の 維持 と モー ショ ン キ ャ プチ ャ デー タ の 追跡 を 同時 に で きる よう に する 新しい フレ ー ム ワ 
ー ク を 提供 する 。 コ ント ロー ラ 1 00 は ロボ ッ ト 103 の 簡易 動力 学 モ デル に 対し て 設 語 
され た バラ ンス コン トロ ー ラ 1 01 と 個々 の 関節 に 対す る トラ ッ キ ング コン トロ ー ラ 1 0 
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2 を 組み 合わ せ て な る 。 最適 化 器 402c は 、 バ ラン ス 及 び ト ラッ キン グ 用 の 両 コ ント ロ 
ー ラ 1 0 1 及び コン ト ロー ラ 1 0 2 の 出力 を 尊重 し て ロボ ッ ト 1 0 3 が 基準 関節 軌道 を ト 
ラッ キン グ し な が ら バ ラン ス を 維持 で きる よう な 関節 トル ク を 得る 。 

[0080) 

評価 ノシ ミュ レー ショ ン と 関連 し て 説明 し た よう に 、 バ ラン スコ ント ロー ラ 1 01 は 種 
々 の タイ プ の 外乱 、 例 えば 簡易 動力 学 及び 全身 動力 学問 の 差 、 慣 性 パラ メー タ 誤 差 、 バ ラ 
ンス コン トロ ー ラ 1 0 1 に 未知 の 関節 動作 及び 外部 力 に 対処 で きる 。 一 般 に 、 倒立 振子 モ 
デル 及び 簡単 な COM 帰 還 制 御 は 質 的 に 同等 の COP 位 置 を 生じ る 。 し か し 、 最 適 な 帰還 
利得 を 決定 する こと は 難し く 、 誤 っ た 利得 選択 が 不 所 望 の 挙動 を 生じ る 。 従っ て 、 状 態 帰 
還 コ ント ロー ラ を 倒立 振子 モデ ル に 対し て 設計 する こと が で きる 。 

【0081】 

更に 、 モ ーション キャ プチ ャ デー タ は 対象 と ヒュ ー マ ノ イド モデ ル と の 間 の 不可 避 の 不 
一 致 の た め に 誤り を 生じ や すく 、 動作 の 間 中 所 望 の 接触 状態 が 満足 され る よう に する た め 
に 前 処理 が 通常 必要 と され る 点 に 注意 す ベ べき で ある 。 対照 的 に 、 本 発明 の 実施 例 に よる コ 
ント ロー ラ 1 00 は (小さ な 帰還 利得 に より 関節 を 足 の 微小 な ミス アリ メン ト に 調整 で き 
る た め に ) 殆ど 前 処理 を 必要 と し な い 。 更に 、 前 処理 は リア ル タ イ ム で 実行 する の に 十分 
に 簡単 で ある 。 

【0082】 

ロボ ッ ト に 対す る 足踏み を 有する 動作 デー タ の コン トロ ロー ルー アウ ェ ア マ ッ ピ ング 
【0083】 

説明 を ロボ ッ ト に 対す る 足踏み 動作 を 含む モ キー ショ ン キ ャ プチ ャ デー タ ( 例え ば ヒュ ー 
マン モー ショ ン キ ャ プチ ャ デー タ ) の コン トロ ー ル ー ア ウェア マッ ピン グ が 与え られ る 本 
発明 の 実施 例 に 戻す 。 本 発明 の 実施 例 は 、 現 在 の 状態 及び コン トロ ー ラ の 挙動 を 考慮 し て 
、 足 踏み 動作 を 含む モー ショ ン キ ャ プチ ャ デー タ を モデ ル に マッ プ す る 。 動作 が 追跡 され 
る と と も に 所 望 の 接触 状態 が 達成 され る よう に 関節 角度 、 体 幹部 及び 重心 ( COG) 軌道 
を 修正 する マッ ピン グ プ ロ セス が 説明 され る 。 

【0084】 

第 1 の ステ ッ プ は 、 関節 角度 及び 体 幹部 軌道 を ロボ ッ ト 運動 学 及び 実際 の 接触 足 位置 に 
適応 する よう に 修正 する 。 第 2 の ステ ッ プ は 予測 圧力 中 心 (COP ) を 用 いて バラ ンス コ 
ント ロー ラ が ロボ ッ ト の バラ ンス を 首尾 よく 維持 で きる か 決定 し 、 で き な い 場合 に COM 
軌道 を 修正 する 。 ヒ ュー マ ノ イ ドモ ーション 合成 の た め の 既 存 の アプ ロー チ と 異な り 、 提 
素 の マッ ピン シグ 方 法 は ロボ ッ ト コ ント ロー ラ と 富 に 関連 し で いる 。 この アプローチ は 、 て 
こ で 検討 され て いる よう に 、 例 えば 体系 化 さ れ て な い 接 触 状 態 変化 を 含む 太極 拳 の 動作 シ 
ー ケ ンス と 関連 する 非 限定 例 を 用 いて シミ ュ レ ーション に より 検証 され て いる 。 
【0085】 

現在 の ロボ ッ ト 状態 及び 接触 状態 な ら び に ロボ ッ ト コ ント ロー ラ の 挙動 を 考慮 する オン 
ライ ン モ ーション マッ ピン グ 技 術 が 以下 で 検討 され る 。 も っ と 詳し く 言 うと 、 同 時 の バラ 
ンス 及び トラ ッ キ ング 制御 に 一 般 に 関連 する 上 記 の 説明 は 、 バ ラン スコ ント ロー ラ が 圧力 
中 心 (COP ) を モー ショ ン の 間 中 接触 凸 包 内 に 維持 し な が ら バ ラン ス を うま くく 維持 で き 
る よう に 関節 角度 、 体 幹部 及び 重心 ( COG ) 軌道 を 調整 する 機能 の 付加 に よっ て 補足 さ 
れる 。 提案 の 方 法 は 体系 化 さ れ て な い 接 触 状態 変化 を 有する 動作 を 全身 動力 学 シ ミュ レー 
ショ ン に よっ て うま く 実 現す る こと が で きる 。 

【0086】 

本 発明 の 実施 例 は 、 モ ーション 合成 と ロボ ッ ト 制御 が 別々 に 処理 され る ヒュ ー マ ノ イド 
制御 に お ける 既存 の 研究 と 相違 する 。 本 発明 の 実施 例 に よる コン トロ ー ラ フレ ー ム ワー ク 
に お いて は 、 モ ーション 合成 と 制御 コン ポー ネン ト が 、 現 在 状態 と 基礎 コン トロ ー ラ を 承 
知 し た マッ ピン グ プ ロ セス に よっ て 蜜 に 関連 し て いる 。 

【0087】 

図 8 に 示さ れる よう に 、 本 発明 の 一 実施 例 に よる 追跡 及び バラ ンス 制御 は 、 本 質 的 に 、 

基準 入力 を 受信 し 、 前 処理 ( マッピング) を 適用 し 、 そ の 後 バ ラン ス 及 び ト ラッ キン グ コ 
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ント ロー ラ を 使用 し 、 基 準 入 力 を 追跡 で きる よう に ロボ ッ ト 関 節 に 適切 な トル ク を 供給 す 
る 。 例え ば 、 モ ーション キャ プチ ャ シス テム か ら の 基準 動作 デー タ が 8 1 0 で 受信 され 、 
前 処理 され る 。 受信 動作 デー タ を 前 処理 する た め に 、 運 動 学 的 マッ ピン グ 82 0 及び 動力 
学 的 マッ ピン グ 8 3 0 が 以下 に 更に 論じ る よう に 適用 され る 。 その 後 、 前 処理 され た 基準 
動作 デー タ が 、 所 定 の 帰還 入力 ( 例え ば 、 現 在 の 接触 位置 ) と 一 緒 に 、 バ ラン ス 制 御 8 4 
0 及び 追跡 制御 8 5 0 の た め に 使用 され 、 こ れ に より ロボ ッ ト は バラ ンス を 維持 し な が ら 
基準 動作 デー タ を 適切 に 追跡 する よう に その 関節 を 動か すこ と が で きる 。 

【0088】 

図 9 を 参照 する と 、 足 踏み 動作 に 対し て コン トロ ー ル -ー ア ウェア マッ ピン グ を 提供 する 
本 発明 の 実施 例 は 、 上 述 し た コン トロ ー ラ 1 00 (バラン スコ ント ロー ラ 1 0 1 及び トラ 
ッ キ ング コン トロ ー ラ 1 02 を 備え る ) に 類似 の コン トロ ー ラ 900 を 用 いる 。 コ ント ロ 
ー ル ー ア ウェ アマ ッ ピ ング を 用 いる 実施 例 に より 導入 され る 主 な 差異 は 、 ロ ボット 903 
で 類似 の 動作 を 実現 する た め に 基準 動作 ( モー ショ ンク リッ プ ) 9 04 に いく つか の タイ 
プ の 調整 を 実行 する 前 処理 コン ポー ネン ト 9 0 5 の 追加 に ある 。 

【0089】 

図 1 0 (8)-(c) は 足踏み 動作 に 対し て 制御 アウ ェ ア マ ッ ピ ング を 用 いる 本 発明 の 実施 例 
の 動作 例 を 示す 。 ロ ボッ ト 1 0 0 3 (8)-(c) は 、 図 1 0 (』) に 示す 初期 姿勢 か ら 出 発し て 一 
方 の 足 を 上 げ よ うと し て いる も の と 仮定 する 。 脚 関節 角度 を 変化 させ た だ け で は 、COM 
は 足 の 中 心 に 位置 し た まま で ある が COP は 支持 脚 の 下 に 移動 する た め 、 図 1 0 (a) に 示 
す よ うに ロボ ッ ト 1 0 0 3 (ag) は 転倒 する 。 

【0090】 

足 を 首尾 よく 上 げ る た め に は 、 図 1 0 (b)D に 示す よう に 、 ロ ボッ ト 1 0 0 3 (b) は 最初 に 
COP を 動か すこ と に よっ て COM を 支持 脚 の 方 へ 移動 させ な けれ ば な ら な い 。 し か し 、 
図 1 0 (cc に 示す よう に に COM オフセット が 大 きす ぎ て バラ ンス コン トロ ー ラ に より 処理 
で き な い 場合 に は 、 ロ ボッ ト 1 003c は バラ ンス を 維持 する こと は で き な い 。 こ の 例 は 
2 つの 重要 な 観察 、 即 ち (1) マ ッ ピ ング プロ セス は 接触 状態 の 変化 に 対す る 準備 を 該 変化 
が 実際 に 起こ る 前 に 開始 させ る 必要 が ある こと 及び (22 マ ッ ピ ング プロ セス は 適切 な 調整 
量 を 決定 する た め に コン トロ ー ラ 900 の 能力 を 知っ て いる 必要 が ある こと を 暗示 し て い 
る 。 

【0091】 

図 9 は 本 発明 の 一 実施 例 に よる コン トロ ー ラ を 示す 。 図 1 に 示す コン トロ ー ラ 1 0 0 は 
無 修 正 の モー ショ ン シ ー ケ ンス を 基準 と し て 取っ た 。 図 9 に 示す コン トロ ー ラ フレ ー ム ワ 
ー ク に お いて は 、 モ ーション クリ ッ プ 904 を 最初 に 2 つの マッ ピン グ コ ン ポ ー ネ ン ト 9 
0 5 (a-bD に よっ て 、 ロ ボッ ト 903 が COM 及 び COP 位置 の 現在 測定 値 を 用 いて バラ 
ンス コン トロ ー ラ 9 0 1 で バラ ンス を 維持 で きる よう に 処理 する こと が で きる 。 動力 学 的 
マッ ピン グ コ ン ポ ー ネ ン ト 905b は 、 バ ラン スコ ント ロー ラ 9 0 1 の 挙動 を 予測 する た 
め に バラ ンス コン トロ ー ラ 9 0 1 の コピ ー も 有する 。 

[0092) 

前 処理 (マッ ピン グ ) コ ン ポ ー ネ ン ト 905 は 運動 学 的 コン ポー ネン ト 905a 及び 動力 
学 的 コン ポー ネン ト 905b を 含む 。 運動 学 的 マッ ピン グ コ ン ポ ー ネ ン ト 905a は 現在 
の 接触 位置 を 用 いて 、 元 の 関節 角度 及び 体 幹部 の 軌道 を 、 接触 域 と ロボ ッ ト 903 と の 間 
の 運動 学 的 関係 が 基準 動作 ( 所 望 の フォ ー ム 、 例 えば モー ショ ンク リッ プ 9 0 4 ) に 似る 
よう に 修正 する 。 動力 学 的 マッ ピン グ コ ン ポ ー ネ ン ト 905b は 、 簡 易 ロ ボッ トモ デル に 
より 予測 され る 将来 の COP 位置 が 接地 凸 包 か ら 出 る 場合 に 、 バ ラン スコ ント ロー ラ 9 0 
1 に 与え られ る 規準 COM の 軌道 を 修正 する 。 

【0093】 

ここ で は 元 の 基準 動作 9 04 に つい て 以下 の よう に 仮定 する 。 即ち 、(1) 初期 フレ ー ム 
で は ( 基準 ) 対象 の 両足 が 床 に 平ら に 接触 し て いる 。 他 の フレ ー ム で は 任意 の 接触 状態 が 
許さ れる 。 (2) 対 象 は 足 を 介し て 水平 な 床 と 物理 的 相互 作用 を 行う の み で ある 。(3) フ レー 
ム 毎 に 少な く と も 片足 が 床 と 接触 する 。(49 フ レー ム 毎 に 接触 する リン ク の 組 が 既知 で あ 
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る 。 接触 は 初期 フレ ー ム を 除い て 平ら に する 必要 は な く 、 使 用 する 接触 状態 情報 ( つま 先 
又は か か と 接触 な ど ) も 詳 述 する 必要 が な い 。 

【0094】 

バラ ンス 及び トラ ッ キ ング コン トロ ー ラ 

【0095】 

足踏み 動作 と 関連 する 本 発明 の 実施 例 に 使用 され る バラ ンス コン トロ ー ラ 9 0 1 及び ト 
ラッ キン グ コ ント ロー ラ 9 0 2 を 以上 に 十分 に 検討 し た が 、( 例え ば 足踏み 動作 と 同様 に 
) 可動 台 を 考慮 する た め に これ ら を 簡単 に 再 検 討 し 、 明 ら か に する 。 

【0096】 

バラ ンス コン トロ ー ラ 9 0 1 は 入力 と し て 基準 COM を 取り 、 簡易 ロボ ッ ト モ デル に 対 
し て 設計 され た 最適 コン トロ ー ラ を 用 いて (所 望 の )COP の 位置 を 決定 する 。 こ こ で は 、 
最適 コン トロ ー ラ は 図 3 に 示さ れる よう な 可動 台 を 有する 3 次元 、2 関 節 の 倒立 振子 に 対 
し て 設計 され て いる も の と 仮定 する 。 こ の モデ ル で は 、 全 ロボ ッ ト 本体 が ロボ ッ ト 903 
の COM に 位置 する 質点 に より 表 さ れ 、 可 動 台 の 位置 が COP を 表す 。 

【0097】 


現在 状態 を 推定 する た め に 最適 コン トロ ー ラ を オブ ザー バ と 組み 合わ せる と 、 


全 バ ラン スコ ント ロー ラ 9 0 1 法 方程 式 (1 1) で 記述 され 、 こ こ で は 倒立 


振子 の 推定 状態 で あり 、u、 は バラ ンス コン トロ ー ラ 9 0 1 の 入力 で あり 、 こ の 
入力 は 基準 COM 位 置 及び 測定 COM 及 び COP 位 置 を 含む の トラ ッ キ ング コ 


ント ロー ラ 9 0 2 に お いて 、\ の 可動 台 位 置 要素 が 所 望 の COP 位 置 と し て 使 
用 され る 。 


[0098]】 


トラ ッ キ ング コン トロ ー ラ 90 2 は 最初 に 、 分解 加 速度 制御 (方 程 式 (1 6)) 
と 同じ 帰 本 及び フィ ー ド フォ ワー ド 方 法 を 用 いて 、 所 望 の 関節 及び 体 幹部 加速 


度 ず を 計算 する 。 こ こ で 、q は 現在 関節 位置 、qrg は キャ プチ ャ デー タ の 基準 
関節 位置 、k ,及 不 。 は 関節 毎 に 相違 し 得る 一 定 の 位置 利得 及び 速度 利得 で あ 
る 。 所 望 の 加速 度 も 同じ 制御 方 法 を 用 いて 体 幹部 及び 足 リ ンク の 6 つの 自由 度 
(DOF) に 対し て 計算 され る 。 


【0099】 

トラ ッ キ ング コン トロ ー ラ 902 は 次 に COP、 関節 加速 度 及び 足 加速 度 誤差 を 含む コ 
スト 関数 を 最適 化す る 関節 トル ク を 得る た め に 最適 化 問題 を 解く 。 

【0100】 

運動 学 的 マッ ピン グ 

【0101】 

運動 学 的 マッ ピン グ は 、 本 発明 の 一 実施 例 に よれ ば 、 以 下 に 説明 する よう に 、 マ ッ ピ ン 
グモ ジュ ー ル 905a を 用 いて 達成 され る 。 運動 学 的 マッ ピン グ の 本 質 的 要素 は ( 上 述 し 
た ) 関節 角度 マッ ピン グ 及 び 以 下 に 更に 説明 する 体 幹部 軌道 マッ ピン グ を 含む 。 
[O102] 

モー ショ ン キ ャ プチ ャ デー タ の 基準 体 幹 部 位置 及び 向き を 基準 接触 位置 及び 実際 の 接触 
位置 の 差 を 考慮 する よう に グロ ー バ ル に 変換 する 調整 が 行わ れる 。 足 は 制御 誤差 の た め に 
基準 位置 に 着地 で き な い か も し れ な い 。 こ の よう な 場合 に 、 同 じ 基 準 位置 を 体 幹部 に 対し 
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て 用 いる と 、 接触 域 に 対す る その 位置 の 差 の た め に 転倒 する こと に な る 。 
【0103】 
そこ で 、 本 発明 の 一 実施 例 は 、 新 し い 接 触 が 確立 され る 度 に 、 平 行 移動 、 回 
転 及 び ス ケー リン グ を 体 幹部 軌道 に 適用 する 。 図 1 1 は 各 変 換 を 決定 する た め 
に 使用 する パラ メー タ を 要約 し て いる 。 最 初 に 、( 単 に 全 接触 点 の 平均 取る こと 
に よっ て ) 基準 及び 実際 の 接触 凸 包 の 中 心 : 


i 
6 , (30) 
ce テー ルウ GD 


が 計算 され る 。 ここ で 、C 及び と は それ ぞ れ 基準 及び 実 動作 の 接触 凸 包 の 中 心 
で あり 、M は 接触 点 の 数 で あり 、 の, 及び の , は 基準 及び 実 動作 の i 番 接触 点 の 
位置 で ある 。 


【0104】 
次 に 、 そ れ ら の 中 心 に 対す る 接触 点 位置 の 主 成分 解析 が 行わ れる 。 の 及び 


の 」 は 最初 の フレ ー ム の x 軸 に 対す る 第 1 の 主 成分 軸 の 角度 を 示す も の と する 。 
また 、$, 及 び ゞ , (=1.2) 


は 基準 及び 実 接触 点 の 特異 値 を 示す 。 
【o105】 
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基準 体 幹部 位置 了 及び 向き RR の 対 に 対し て 、 変 換 さ れ た 位置 p 及 び R は 次 の 
よう に 得 ら れる 。 


p=HS(p-©)+c (32) 
R=QR 33) 
Ct 
sa/ 0 0 
ざ =| 0 5/$ 0 (34) 
0 0 1 


及び Q は 乗 直 軸 を 中 心 と する @」 一 の , の 回 転 を 表す 回 転 行列 で ある 。 


【0106】 

変換 は 接触 が 確立 され る と き に の み 更 新 さ れる 点 に 注意 され た い 。 足 が 接 触 状態 で まだ 
動く 可能 性 が ある と き に 変換 が 更新 され た 場合 、 ト ラッ キン グ コ ント ロー ラ 902 は 接触 
位置 を 変換 の 更新 と 同じ 方 向 に 動か す た め 、 正 帰還 が 与え られ る 。 そ れ ゆ え 、 変換 は 、 接 
触 状態 の 各 リ ンク の 垂直 接触 力 が 基準 動作 に お ける 接触 状態 の 変化 後に 大 き な し きい 値 を 
超え る と き に の み 更 新 す る の が 好ま し い 。 

【0107】 

動力 学 的 マッ ピン グ 
【0108】 

本 発明 の 一 実施 例 は 、 バ ラン スコ ント ロー ラ 90 1 が 与え られ た 接触 域 で ロボ ッ ト 90 
3 を バラ ンス し た 状態 に 維持 で きる よう に 基準 動作 の COM 軌 道 を 修正 する 。 こ の マッ ピ 
ング プロ セス は 、 現在 の ロボ ッ ト 状態 と 元 の 基準 COM 軌 道 と に 基づい て 将来 の COP 位 
置 を 予測 する 。COP が 接触 凸 色 か ら 出 る 場合 に は 、COP が 接触 凸 包 内 に と ど ま る よう 
に 新しい COM 軌 道 を 計算 し 、 次 の COM 位 置 を バラ ンス コン トロ ー ラ 901 に 基準 CO 
M と し て 送る 。 

【0109】 

一 般 に 図 1 2 を 参照 し て 、 修 正 さ れ た COP 位置 を 得る 方 法 が 以下 に 説明 され る 。 方 程 
式 ( 1 1 ) と 同じ 最適 コン トロ ー ラ に 基づい て 、 バ ラン スコ ント ロー ラ 90 1 の 離散 化 状 
態 方 程 式 モ デル : 

xXxu=Ax, 二 Bur (35) 

が 得 ら れる 。 こ こ で 、x, は 状態 で あり 、u, は サン プリ ング 時 刻 k に お ける 入力 で ある 。 
バラ ンス コン トロ ー ラ 201(1 1 ) と 異な り 、 こ こ で は 実測 値 は 使用 され な いた め コ ン 
トロ ー ラ モデ ル ( 3 5 ) は オブ ザー バ を 含ま な い 。 従っ て 、u は 基準 動作 の COM 軌 道 
を 含む お のみ で ある 。 COP 位置 が 出力 と し て 選択 され 、 そ の 結果 出力 方 程 式 は : 
Yi=Cxi (36) 

と 規定 され る 。 

[O110) 
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所 定 の 初期 状態 x。 及 び 湊 の nm フレ ー ム に 対す る COM 軌 道 


77, (k=0.1…n-1) に 対し て 、n フ レー ム 後 の COP の 位置 は 、 
=C(A ro + MU,) G7) 


に より 予測 する こと が で きる 。 こ こ で 、 


M,=(A"™B A™B ... B) (38) 
4 

。 | 

Un=| ; | (39) 


次 に 、 基 準 関節 角度 を 用 いて ア , が 当該 フレ ー ム の 接触 凸 名 内 に 位置 する か どう 
か の 検査 が 行わ れる 。 実 際 に は 、n に 対し て 最大 値 N が 選択 され 、 こ の 値 が 最 
大 ルッ クア ヘッ ド を 決定 する た め に 使用 され る 。 


【0111】 


了 が フレ ー ム nm に お ける 接触 上 包 か ら 出 る こと が 検出 され る 場合 に は 、 ア 。 
が 接触 凸 包 内 に と ど ま る よう に 基準 COM 軌 道 が U′ に 修正 され る 。U' を 得る 
ー つ の 方 法 は 、 下 記 の 最適 化 問題 : 

U’=argminZ 
U 
を 解く も の で ある 。 ここ で 、 コ スト 関数 は 


(40) 


ZO Yi) Og) 


+ ュ ( り - の (の - の 。)。 (41) 


で ある 。 yr は 接触 凸 包 内 の 所 望 の COP で あり 、W は 一 定 の 正 値 加重 行列 で 
あり 、 


CA +MU) (42) 
で ある 。 


【0112】 
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第 1 項 は COP を 選択 され た 点 y 。 に で きる だ け 近 づけ よう と する が 、 第 2 項 は 元 の 
COM 軌 道 か ら の 偏差 に ペナ ル テ ィ ー を 課す 。y 。』 及 び W の 選択 は 次 の 段落 で 検討 する 
[O113) 

原理 上 、y 。 は 接触 凸 包 内 の 任意 の 点 と する こと が で きる 。 し か し 、 実 際 に は y を 
決定 する た め に 2 つの 課題 が 考え られ る 。 第 1 に 、 得 られ る COP が y 。 に 正確 に な ら 
な いか も し れ な いた め 、 境 界 か ら の 安全 マー ジン を 維持 する 方 が よい 。 ま た 、COM 軌 道 
の 変化 は 最小 に すべ き で ある と と も に 、 元 の 基準 動作 を で きる だ け 維 持 す べき で ある 。 両 
課題 を 考慮 する た め に 、 最 初 に 、 接 触 凸 包 境 界 上 の 最近 点 を 予測 され た COP, b から 得 
る 。 接触 凸 包 の 中 心 も 計 算 す る 。 次 に 、y 。 を 、 

yhb 十 (1-h)c 
に より 得る 。 こ こ で 、h =h 』(N-n ) 人 NN で あり 、h 。』。 は ユー ザ 指 定 の 定数 で ある 。 

b 及び c 間 の この 補間 に より 、y 』 は n が 大 きく な る に つれ て c に 近づき 、 こ れ は CO 
M を 短期 間 で 変化 させ る こと が より 困難 に な る と いう 観察 に 基づく 。 
【0114】 

W は COM 軌 道 が 元 の 軌道 か ら ど の ぐら い 外 れ て も よい か を 表す 。 最終 フレ ー ム で 元 の 
COM 位 置 へ 戻す の が 望ま し いた め 、 前 期 フ レー ム に 小さ い 値 を 与え 、 後 期 フ レー ム に 大 
き な 値 を 与え る の が 合理 的 で ある 。 本 発明 の 一 実施 例 に よれ ば 、W の i 番 対 角 成 分 は wi 
"に より 計算 され る (ここ で w は ユー ザ 指 定 の 定数 で ある ) 。 

【0115】 

シミ ュ レ ーション 結果 
【0116】 

本 発明 の 一 実施 例 に よる コン トロ ー ラ 900 の 有効 性 は 鋼 体 接触 モデ ル 及 び フ ォ ワ ー ド 
動力 学 プ ロ セ ス に 基づく シミ ュ レ ー タ に よっ て 検証 し た 。 上 述 し た ヒュ ー マ ノ イド ロボ ッ 
ト の モデ ル を 以下 に 記載 する シミ ュ レ ーション に も 使用 し た 。 

【0117】 

バラ ンス コン トロ ー ラ 1 01 と 関連 し て 説明 し た も の と 同じ 線形 二 次 レ ギュ レー タ を 同 
じ パ ラメ ー タ と と も に 使用 し た 。 ト ラッ キン グ コ ント ロー ラ の 帰還 利得 は k. 三 25 及 び 
k 三 1 0 と し た 。 調整 コン ポー ネン ト に 対す る パラ メー タ は N=100、h。 三 0.8 
及び W= テ 0 . 0 0 1 と し た 。 制御 シス テム (35) は 5ms の サン プリ ング 時 間 で 離散 化 
し た 。 こ れ は 、COM 修 正 が 必要 と され る どう か を 決定 する た め に 動力 学 的 マッ ピン グ コ 
ン ポ ー ネ ン ト を 0. 5s 後に 調べ る こと を 意味 する 。 離散 化 の た め の サ ンプ リン グ 時 間 は 
必ず し も 制御 サイ クル と 同じ に する 必要 は な い 。 実際 に は 、 方 程 式 (35 ) の た め に 制御 
サイ クル より 大 きい サン プリ ング 時 間 を 使用 し て 動力 学 的 マッ ピン グ た め の 計 算 時 間 を 短 
縮 す る こと が で きる 。 

【0118】 

動力 学 的 マッ ピン グ の 例 
【0119】 

最初 に 、 足 踏み 動作 を 実現 する た め に 動力 学 的 マッ ピン グ が 必要 と され る 簡単 な 例 に つ 
いて 説明 する 。 基準 動作 は 手 作 業 で 生成 され た 簡単 な 動作 で あり 、 こ の 基準 動作 は 、 右 足 
が t =1 . 0 ~2. 0O 秒 の 期間 中 持ち 上 げ ら れ 、 そ の 間 左 足 が 床 に 平ら に 接触 し て いる も 
の で ある 。 図 1 3 の 上 の グラ フ は 、 簡単 な 右足 持ち 上 げ 例 に 対す る 基準 COM( マッ ピン 
グ な し ) 、 基 準 COM( マ ッ ピ ング あり ) 、 実 COM( マ ッ ピ ング な し ) 及び 実 COM( 
マッ ピン グ あ り ) の 各 軌 道 を 示す 。 下 の グラ フ は 、 実 COP( マ ッ ピ ング な し ) 及び 実 C 
OP ( マッ ピン グ あ り ) の 各 軌 道 を ロボ ッ ト の 側面 に 沿っ て 示し 、 正 軸 が 左側 を 指し て い 
る 。 下 の グラ フ の 足 領 域 は 左足 の 接触 域 を 示す 。 下 の グラ フ は 、COP は 動力 学 的 マッ ピ 
ング な し で は 決し て 左足 に 到達 し な いた め 、 ロ ボッ ト は (マッ ピン グ な し で は ) 右足 を 持 
ち 上 げ る こと は で き な い 。 他方 、 マ ッ ピ ング が ター ン オ ン さ れる と 、 持 ち 上 げ 時 間 が CO 
P 予測 ウィ ンド ウ 内 に 入る t =0. 5 秒 の 時 点 で 基準 COP が 修正 され 、 動 力学 的 マッ ピ 
ング コン ポー ネン ト 905b は その と き COP が 左足 の 下 に な いこ と に 気づく 。COP は 
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、 新 し い 基 準 COM に 応答 し て 、 最 初 右足 の 方 へ 移動 し 、 こ れ に より COM が 更に 左足 の 
方 へ 追い や られ る 。COP は 最終 的 に は t =0. 8 秒 の あたり で 左足 に 到達 する た め 、 ロ 
ボッ ト は 右足 を 持ち 上 げ る こと が で きる 。 


【0120 
複雑 な 動作 へ の 応用 
【0121 


複雑 な 動作 が 本 発明 の 実施 例 に より 適切 に 処理 され た こと を 確認 する た め に 、CMU モ 
ーション キャ プチ ャ デー タラ イブ ラリ か ら の 太極 拳 の モー ショ ン キ ャ プチ ャ シー ケン ス を 
使用 し 、 非 限定 例 と し て 以下 に 記載 し た 。 マ ー カ ーー 位置 デー タ は 、 関 節 動作 範囲 の 制約 を 
有する 逆 運 動 学 プ ロ セ ス に よっ て 関節 角度 デー タ に 変換 し た 。 太極 拳 動作 を 一 例 と し て 選 
択 し た 。 そ れ は 、 太 極 拳 動作 は 多く の 体系 化 さ れ て な い 接 触 状態 変化 、 例 えば つま 先 接触 
又は か か と 接触 へ の 移行 及び 接触 し た まま で の 足 の 僅か な 移動 な ど を 含む た めで ある 。 シ 
ミュ レー ショ ン 動 作 は 複雑 な 太極 拳 動作 の モー ショ ン キ ャ プチ ャ デー タ を 忠実 に 再現 し た 
【0122】 

従っ て 、 本 発明 の 一 実施 例 は 足踏み な どの 複雑 な 動作 を 含む ヒビ ュー マン モー ショ ン キ ャ 
プチ ャ デー タ を ヒュ ー マ ノ イド ロボ ッ ト に マッ ピン グ す る 方 法 も 提供 する 。 注目 すべ き 特 
微 は せ 、 ロ ボッ ト の 異な る 運動 学 及び 動力 学 に 正しく 対処 し うる の みな ら ず 、 本 発明 の 実施 
例 は 現在 の ロボ ッ ト 及び 接触 状態 並び に バラ ンス コン トロ ー ラ の 能力 に 基づい て 調整 量 を 
正しく 決定 する こと も で きる 。 例え ば 、 シ ミュ レー ショ ン に お いて 、 提 案 の 方 法 は ヒュ ー 
マ ノ イ ドロ ボッ ト に 人 間 の 太極 拳 動作 を 首尾 よく シミ ュ レ ー ト させ る こと が で きる こと が 
証明 され た 。 

【0123】 

当 業 者 は 、 本 発明 の 実施 例 は 一 以上 の コン ピュ ー タ シス テム を 用 いて 実現 で きる こと が 
容易 に 理解 され よう 。 こ れ に 関連 し て 、 非 限定 的 な 模範 的 コン ピュ ー タ シス テム を ここ に 
記載 する 。 

【0124】 

図 1 4 に 示す よう に 、 本 発明 の 態様 は コン ピュ ー タ シス テム 、 例 えば ユー ザワ ー ク ステ 
ーション 、 パ ー ソ ナル コン ピュ ー タ 又は 他 の クラ イア ント デバ イス に お いて 実行 する こと 
が で きる 。 図 1 4 に お いて 、 代 表 的 な コン ピュ ー タ シス テム は 、 コ ンピュータ シス テム に 
一 般 に 含ま れる 、 プ ロ セ ッ サ 、 コ ント ロー ラ な どの 処理 素子 1 4 1 0 及び 関連 する メモ リ 
デバ イス 1 4 20 を 含む こと が で きる 。 更 に 、 コ ンピュータ シス テム は 種々 の 被 接続 装置 
1 430、 例 えば (ヒュ ー マ ノ イド ロボ ッ ト に 組み 込ま れる オン ボー ドコ ンピュータ シス 
テム と の 関連 で は ) ヒュ ー マ ノ イド ロボ ッ ト の よう な 機械 的 人 エエ エー ジェ ント の コン ポー 
ネン ト 、 例 えば セン サ ( エン コー ダ 、 ポ テン シオ メー タ 、 ロ ー ド セル 、 ジ ャ イロ 、 加 人 速度 
計 な ど ) 、 他 の コン ピュ ー タ シス テム な ど に 接続 する こと が で きる 。 

【0125】 

これ に 関連 し て 、 記 載 し た 本 発明 の 種々 の 態様 は 、 例 えば メモ リ デ バ イス 1 4 2 0 に ア 
クセ ス 可 能 の 形 で 格納 され た コン ピュ ー タ プロ グラ ム 命 令 ( コン ピュ ー タ プロ セッ サコ ー 
ド を 含む ) を 実行 する 処理 素子 1 4 1 0 に よっ て 実行 する こと が で きる 。 従っ て 、 こ こ に 
記載 され た 所 定 の オペ レー ショ ン は コン ピュ ー タ 読み 取り 可能 な プロ グラ ム 記 憶 デ バイ ス 
、 例 えば メモ リ デ バ イス 1 4 2 0 に 具体 的 に 記憶 され た コン ピュ ー タ プロ グラ ム 命 令 を 実 
行 す る こと に よっ て 実行 する こと が で きる た め 、 コ ンピュータ シス テム は 特定 の 方 法 で 機 
能 向け に する こと が で きる こと が 理解 され よう 。 

【0126】 

更に 、 本 発明 の 態様 は コン ピュ ー タ 読取 可能 な プロ グラ ムコ ー ド を 有する 一 以上 の コン 
ピュ ー タ 読取 可能 な 媒体 に 具体 化 さ れ た コン ピュ ー タ プロ グラ ム プ ロダ クト の 形 を 取る こ 
と が で きる 。 

【0127】 
一 以上 の コン ピュ ー タ 読取 可能 な 媒体 の 任意 の 組み 合わ せ を 使用 する こと も で きる 。 コ 
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ンピュータ 読取 可能 な 媒体 は コン ピュ ー タ 読取 可能 な 信号 媒体 又は コン ピュ ー タ 読取 可能 
な 記憶 媒体 と する こと が で きる 。 コ ンピュータ 読取 可能 な 記憶 媒体 は 、 例 えば 電子 、 磁 気 
、 光 、 電 磁気 、 赤 外 又 は 半導体 シス テム 、 装置 又は デバ イス も し く は それ ら の 任意 の 適切 
な 組み 合わ せ と す る こと が で きる が 、 こ れ ら に 限定 され な い 。 コ ンピュータ 読取 可能 な 記 
憶 媒体 の も っ と 具体 的 な 例 ( 不 完全 な 表 ) は 次 の も の : 一 以上 の ワイ ヤ を 有する 電気 接続 
、 ポー タブ ルコ ンピュータ ディ スケ ッ ト 、 ハ バハ バード ディ スク 、 ラ ンダ ム ア ク セス メモ リ (RR 
AM) 、 リ ー ド オン リ メ モ リ (ROM) 、 消 去 可 能 な プロ グラ マブ ルリ ー ド オン リ メ モ リ 
(EPROM 又 は フラ ッシュ メモ リ ) 、 光 ファ イ バ 、 ポ ー タ ブル コン ピュ ー タ 光ディスク 
リー ド オ ン リ メモ リ (CD-ROM) 、 光 記憶 デバ イス 、 磁 気 記 憶 デ バイ ス 、 ま た は それ 
ら の 任意 の 適切 な 組み 合わ せ を 含む 。 本 明細 書 に お いて 、 コ ンピュータ 読取 可能 な 記憶 媒 
体 は 、 命 令 実行 シス テム 、 装置 又は デバ イス に より 使用 され る 又は 関連 する プロ グラ ム を 
含む 又は 格納 し 得る 任意 の 実現 可能 な 媒体 と する こと が で きる 。 

【0128】 

コン ピュ ー タ 読取 可能 な 信号 媒体 は 媒体 内 に 具体 化 さ れ た コン ピュ ー タ 読取 可能 な コン 
ピュ ー タ 読取 可能 な プロ グラ ムコ ー ド を 例え ば ベー スバ ンド で 又は 搬送 波 の 一 部 と し て 有 
する 伝播 デー タ 信 号 を 含む も の と し 得る 。 こ の よう な 伝播 信号 は 、 電 磁気 、 光 又は それ ら 
の 任意 の 組み 合わ せ を 含む 様々 な タイ プ の 何れ か と する こと が で きる が 、 こ れ ら に 限定 さ 
れ な い 。 コ ンピュータ 読取 可能 な 信号 媒体 は 、 命 令 実 行 シ ステ ム 、 装置 又は デバ イス に よ 
り 使 用 され る 又は 関連 する プロ グラ ム を 伝達 する 、 伝 播 する 又は 転送 する 、 コ ンピュータ 
読取 可能 な 記憶 媒体 で な い 任 意 の コン ピュ ー タ 読取 可能 な 媒体 と する こと も で きる 。 コ ン 
ピュ ー タ 読取 可能 な 媒体 に 具体 化 さ れ た プロ グラ ムコ ー ド は 、 無線 、 有 線 、 光 ファ イ バ ケ 
ー ブ ル 、RF 等 又は それ ら の 任意 の 適切 な 組み 合わ せ を 含む 任意 の 適切 な 媒体 を 用 いて 伝 
送 で きる が 、 こ れ ら に 限定 され な い 。 

【0129】 

本 発明 の 態様 の た め の オ ペレ ーション を 実行 する コン ピュ ー タ プロ グラ ムコ ー ド は 、J 
a b a (登録 商標 )、C 十 士 な どの オブ ジェ クト 指向 プロ グラ ミン グ 言 語 及 び "C" プロ グ 
ラミ ング 言語 の よう な 慣例 の プロ シー ジャ プロ グラ ミン グ 言 語 又は 屋 次 の プロ グラ ミン グ 
言語 を 含む 一 以上 の プロ グラ ミン グ 言 語 の 任意 の 組み 合わ せ で 書き 込む こと が で きる 。 プ 
ログ ラム コー ド は ユー ザ の コン ピュ ー タ (デバ イス ) で 完全 に 実行 する 、 又 は スタ ンド アロ 
ン ソ フト ウェ アパ ッ ケ ー ジ と し て ユー ザ の コン ピュ ー タ で 部 分 的 に 実行 する 、 又 は ユー ザ 
の コン ピュ ー タ で 部 分 的 に 且つ リモ ー ト コン ピュ ー タ で 部 分 的 に 実行 する 、 又 は リモ ー ト 
コン ピュ ー タ で 完全 に 実行 する こと が で きる 。 後者 の シナ リオ に お いて は 、 リ モー トコ ン 
ピュ ー タ は ロー カル エリ アネット ワー ク (LAN) 又は ワイ ド エ リ アネット ワー ク ( WA 
N ) を 含む 任意 の タイ プ の ネッ トワ ー ク で ユー ザ の コン ピュ ー タ に 接続 する こと が で き 、 
この 接続 は ( 例え ば 、 イ ンタ ーネット サー ビス プロ バイ ダ を 用 いる イン ター ネッ ト を 介し 
て ) 外部 コン ピュ ー タ へ と 行う こと も で きる 。 

【0130】 

本 発明 の 態様 は 、 本 発明 の 実施 例 に よる 方 法 、 装 置 ( シス テム ) 及び コン ピュ ー タ プロ 
グラ ム プ ロダ クト の フロ ー チ ャ ー ト 及び 又は ブロ ッ ク 図 を 参照 し て ここ に 記載 され て い 
る 。 フ ロー チャ ー ト 及び 又は ブロ ッ ク 図 の 各 ブ ロッ ク 又 は フロ ー チ ャ ー ト 及び 又は ブ 
ロッ ク 図 の ブロ ッ ク の 組み 合わ せ は コン ピュ ー タ プロ グラ ム 命 令 で 実行 で きる 。 こ れ ら の 
コン ピュ ー タ プロ グラ ム 命 令 は 汎用 コン ピュ ー タ 、 専 用 コン ピュ ー タ 又は 他 の プロ グラ マ 
ブル デー タ 処 理 装置 に 供給 し て 、 コ ンピュータ の プロ セッ サ 又 は 他 の プロ グラ マブ ル デ ー 
タ 処 理 装置 を 介し て 実行 され る 命令 が フロ ー チ ャ ー ト 及び 又は ブロ ッ ク 図 の 各 ブ ロッ ク 
又は ブロ ッ ク の 組み 合わ せ に 指定 され た 機能 作業 を 実行 する 手段 を 生成 する よう な マシ 
ン を 生成 する こと が で きる 。 

[01311] 

これ ら の コン ピュ ー タ プロ グラ ム 命 令 は 、 コ ンピュータ シス テム 、 他 の プロ グラ マブ ル 
デー タ 処 理 装置 又は 他 の デバ イス を 特定 の 方 法 で 機能 する よう に 命令 し 得る コン ピュ ー タ 
読取 可能 な 媒体 に 格納 し 、 コ ンピュータ 読取 可能 な 媒体 に 格納 され た 命令 が フロ ー チ ャ ー 
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ト 及び プ 又 は ブロ ッ ク 図 の 各 ブ ロッ ク 又 は ブロ ッ ク の 組み 合わ せ に 指定 され た 機能 作業 
を 実行 する 命令 を 含む 製品 を 生成 する よう に する こと も で きる 。 
【0132】 

コン ピュ ー タ プロ グラ ム 命 令 は 、 一 連 の オペ レー ショ ンス テッ プ を コン ピュ ー タ シス テ 
ム 、 他 の プロ グラ マブ ル デ ー タ 処理 装置 又は 他 の デバ イス で 実行 させ て コン ピュ ー タ 実行 
プロ セス を 生成 する た め に コン ピュ ー タ シス テム 、 他 の プロ グラ マブ ル デ ー タ 処理 装置 又 
は 他 の デバ イス に ロー ド し て 、 コ ンピュータ シス テム 、 他 の プロ グラ マブ ル デ ー タ 処理 装 
置 又は 他 の デバ イス で 実行 する 命令 が フロ ー チ ャ ー ト 及び プ 又 は ブロ ッ ク 図 の 各 ブ ロッ ク 
又は ブロ ッ ク の 組み 合わ せ に 指定 され た 機能 作業 を 実行 する プロ セス を 提供 する よう に 
する こと も で きる 。 

【0133】 

本 開示 は 例示 及び 説明 の た めで ある が 、 完 全 又 は 限定 を 意図 する も の で は な い 。 多く の 
変更 及び 変形 が 当 業 者 に 明らか で ある 。 本 発明 の 原理 及び 実用 化 の た め 及 び 当 業者 が 意図 
する 特定 の 用 途 に 適し た 種々 の 変更 を 備え る 種々 の 実施 例 の 開示 を 理解 で きる よう に 、 種 
々 の 実施 例 が 選択 され 記載 され て いる 。 

【0134】 

本 発明 の 説明 の た め の 種 々 の 実施 例 を 添付 図面 を 参照 し て 記載 し た が 、 本 発明 は これ ら 
の 実施 例 に 正確 に 限定 され ず 、 当 業者 に よれ ば 本 発明 の 範囲 又は 精神 か ら 離 れる こと な く 
種々 の 変形 及び 変更 を 加え る こと が で きる 。 
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